b282949af3d791bc7c0c5638849827335396cbe5
[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((char *)&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         if (net == 0)
919                 mask = addr = 0;
920         else {
921                 if (net <= 0xff)
922                         addr = net << 24;
923                 else if (net <= 0xffff)
924                         addr = net << 16;
925                 else if (net <= 0xffffff)
926                         addr = net << 8;
927                 else
928                         addr = net;
929
930                 if (bits)
931                         mask = 0xffffffff << (32 - bits);
932                 else {
933                         if (IN_CLASSA(addr)) {
934                                 mask = IN_CLASSA_NET;
935                         } else if (IN_CLASSB(addr)) {
936                                 mask = IN_CLASSB_NET;
937                         } else if (IN_CLASSC(addr)) {
938                                 mask = IN_CLASSC_NET;
939                         } else
940                                 mask = 0xffffffff;
941                 }
942         }
943         in->sin_addr.s_addr = htonl(addr);
944         in = &so_mask.sin;
945         in->sin_addr.s_addr = htonl(mask);
946         in->sin_len = 0;
947         in->sin_family = 0;
948         cp = (char *)(&in->sin_addr + 1);
949         while (*--cp == 0 && cp > (char *)in)
950                 ;
951         in->sin_len = 1 + cp - (char *)in;
952 }
953
954 #ifdef INET6
955 /*
956  * XXX the function may need more improvement...
957  */
958 static int
959 inet6_makenetandmask(struct sockaddr_in6 *sin6, const char *plen)
960 {
961         struct in6_addr in6;
962
963         if (plen == NULL) {
964                 if (IN6_IS_ADDR_UNSPECIFIED(&sin6->sin6_addr) &&
965                     sin6->sin6_scope_id == 0) {
966                         plen = "0";
967                 } else if ((sin6->sin6_addr.s6_addr[0] & 0xe0) == 0x20) {
968                         /* aggregatable global unicast - RFC2374 */
969                         memset(&in6, 0, sizeof(in6));
970                         if (memcmp(&sin6->sin6_addr.s6_addr[8],
971                                    &in6.s6_addr[8], 8) == 0)
972                                 plen = "64";
973                 }
974         }
975
976         if (plen == NULL || strcmp(plen, "128") == 0)
977                 return(1);
978         rtm_addrs |= RTA_NETMASK;
979         prefixlen(plen);
980         return(0);
981 }
982 #endif
983
984 /*
985  * Interpret an argument as a network address of some kind,
986  * returning 1 if a host address, 0 if a network address.
987  */
988 static int
989 getaddr(int which, char *str, struct hostent **hpp)
990 {
991         sup su;
992         struct hostent *hp;
993         struct netent *np;
994         u_long val;
995         char *q;
996         int afamily;  /* local copy of af so we can change it */
997
998         if (af == 0) {
999                 af = AF_INET;
1000                 aflen = sizeof(struct sockaddr_in);
1001         }
1002         afamily = af;
1003         rtm_addrs |= which;
1004         switch (which) {
1005         case RTA_DST:
1006                 su = &so_dst;
1007                 break;
1008         case RTA_GATEWAY:
1009                 su = &so_gate;
1010                 if (iflag) {
1011                         struct ifaddrs *ifap, *ifa;
1012                         struct sockaddr_dl *sdl = NULL;
1013
1014                         if (getifaddrs(&ifap))
1015                                 err(1, "getifaddrs");
1016
1017                         for (ifa = ifap; ifa != NULL; ifa = ifa->ifa_next) {
1018                                 if (ifa->ifa_addr->sa_family != AF_LINK)
1019                                         continue;
1020
1021                                 if (strcmp(str, ifa->ifa_name) != 0)
1022                                         continue;
1023
1024                                 sdl = (struct sockaddr_dl *)ifa->ifa_addr;
1025                         }
1026                         /* If we found it, then use it */
1027                         if (sdl != NULL) {
1028                                 /*
1029                                  * Copy is safe since we have a
1030                                  * sockaddr_storage member in sockunion{}.
1031                                  * Note that we need to copy before calling
1032                                  * freeifaddrs().
1033                                  *
1034                                  * Interface routes are routed only by their
1035                                  * sdl_index or interface name (we provide
1036                                  * both here), not by the ARP address of the
1037                                  * local interface (alen, slen = 0).
1038                                  */
1039                                 memcpy(&su->sdl, sdl, sdl->sdl_len);
1040                                 su->sdl.sdl_alen = 0;
1041                                 su->sdl.sdl_slen = 0;
1042                         }
1043                         freeifaddrs(ifap);
1044                         if (sdl != NULL)
1045                                 return(1);
1046                 }
1047                 break;
1048         case RTA_NETMASK:
1049                 su = &so_mask;
1050                 break;
1051         case RTA_GENMASK:
1052                 su = &so_genmask;
1053                 break;
1054         case RTA_IFP:
1055                 su = &so_ifp;
1056                 afamily = AF_LINK;
1057                 break;
1058         case RTA_IFA:
1059                 su = &so_ifa;
1060                 break;
1061         case RTA_MPLS1:
1062                 su = &so_mpls1;
1063                 break;
1064         case RTA_MPLS2:
1065                 su = &so_mpls2;
1066                 break;
1067         case RTA_MPLS3:
1068                 su = &so_mpls3;
1069                 break;
1070         default:
1071                 usage("internal error");
1072                 /*NOTREACHED*/
1073         }
1074         su->sa.sa_len = aflen;
1075         su->sa.sa_family = afamily; /* cases that don't want it have left
1076                                        already */
1077         if (strcmp(str, "default") == 0) {
1078                 /*
1079                  * Default is net 0.0.0.0/0
1080                  */
1081                 switch (which) {
1082                 case RTA_DST:
1083                         forcenet++;
1084                         /* bzero(su, sizeof(*su)); *//* for readability */
1085                         getaddr(RTA_NETMASK, str, 0);
1086                         break;
1087                 case RTA_NETMASK:
1088                 case RTA_GENMASK:
1089                         /* bzero(su, sizeof(*su)); *//* for readability */
1090                         break;
1091                 }
1092                 return(0);
1093         }
1094         switch (afamily) {
1095 #ifdef INET6
1096         case AF_INET6:
1097         {
1098                 struct addrinfo hints, *res;
1099
1100                 q = NULL;
1101                 if (which == RTA_DST && (q = strchr(str, '/')) != NULL)
1102                         *q = '\0';
1103                 memset(&hints, 0, sizeof(hints));
1104                 hints.ai_family = afamily;      /*AF_INET6*/
1105                 hints.ai_flags = AI_NUMERICHOST;
1106                 hints.ai_socktype = SOCK_DGRAM;         /*dummy*/
1107                 if (getaddrinfo(str, "0", &hints, &res) != 0 ||
1108                     res->ai_family != AF_INET6 ||
1109                     res->ai_addrlen != sizeof(su->sin6)) {
1110                         fprintf(stderr, "%s: bad value\n", str);
1111                         exit(1);
1112                 }
1113                 memcpy(&su->sin6, res->ai_addr, sizeof(su->sin6));
1114 #ifdef __KAME__
1115                 if ((IN6_IS_ADDR_LINKLOCAL(&su->sin6.sin6_addr) ||
1116                      IN6_IS_ADDR_LINKLOCAL(&su->sin6.sin6_addr)) &&
1117                     su->sin6.sin6_scope_id) {
1118                         *(u_int16_t *)&su->sin6.sin6_addr.s6_addr[2] =
1119                                 htons(su->sin6.sin6_scope_id);
1120                         su->sin6.sin6_scope_id = 0;
1121                 }
1122 #endif
1123                 freeaddrinfo(res);
1124                 if (q != NULL)
1125                         *q++ = '/';
1126                 if (which == RTA_DST)
1127                         return(inet6_makenetandmask(&su->sin6, q));
1128                 return(0);
1129         }
1130 #endif /* INET6 */
1131
1132 #ifdef NS
1133         case AF_NS:
1134                 if (which == RTA_DST) {
1135                         struct sockaddr_ns *sms = &(so_mask.sns);
1136                         memset(sms, 0, sizeof(*sms));
1137                         sms->sns_family = 0;
1138                         sms->sns_len = 6;
1139                         sms->sns_addr.x_net = *(union ns_net *)ns_bh;
1140                         rtm_addrs |= RTA_NETMASK;
1141                 }
1142                 su->sns.sns_addr = ns_addr(str);
1143                 return(!ns_nullhost(su->sns.sns_addr));
1144 #endif
1145
1146         case AF_APPLETALK:
1147                 if (!atalk_aton(str, &su->sat.sat_addr))
1148                         errx(EX_NOHOST, "bad address: %s", str);
1149                 rtm_addrs |= RTA_NETMASK;
1150                 return(forcehost || su->sat.sat_addr.s_node != 0);
1151
1152         case AF_LINK:
1153                 link_addr(str, &su->sdl);
1154                 return(1);
1155
1156         case PF_ROUTE:
1157                 su->sa.sa_len = sizeof(*su);
1158                 sockaddr(str, &su->sa);
1159                 return(1);
1160
1161         case AF_MPLS:
1162         {
1163                 mpls_label_t label;
1164
1165                 bzero(su, sizeof(*su));
1166                 su->sa.sa_len = sizeof(*su);
1167                 su->sa.sa_family = AF_MPLS;
1168                 su->smpls.smpls_op = mplsop;
1169                 if (mplsop != MPLSLOP_POP && mplsop != MPLSLOP_POPALL &&
1170                     *str != '\0') {
1171                         if (sscanf(str, "%u", &label) != 1)
1172                                 errx(EX_NOHOST, "bad address: %s", str);
1173                         su->smpls.smpls_label = htonl(label);
1174                 }
1175                 return(1);
1176         }
1177
1178         case AF_INET:
1179         default:
1180                 break;
1181         }
1182
1183         if (hpp == NULL)
1184                 hpp = &hp;
1185         *hpp = NULL;
1186
1187         q = strchr(str,'/');
1188         if (q != NULL && which == RTA_DST) {
1189                 *q = '\0';
1190                 if ((val = inet_network(str)) != INADDR_NONE) {
1191                         inet_makenetandmask(
1192                                 val, &su->sin, strtoul(q+1, 0, 0));
1193                         return(0);
1194                 }
1195                 *q = '/';
1196         }
1197         if ((which != RTA_DST || forcenet == 0) &&
1198             inet_aton(str, &su->sin.sin_addr)) {
1199                 val = su->sin.sin_addr.s_addr;
1200                 if (which != RTA_DST ||
1201                     inet_lnaof(su->sin.sin_addr) != INADDR_ANY)
1202                         return(1);
1203                 else {
1204                         val = ntohl(val);
1205                         goto netdone;
1206                 }
1207         }
1208         if (which == RTA_DST && forcehost == 0 &&
1209             ((val = inet_network(str)) != INADDR_NONE ||
1210             ((np = getnetbyname(str)) != NULL && (val = np->n_net) != 0))) {
1211 netdone:
1212                 inet_makenetandmask(val, &su->sin, 0);
1213                 return(0);
1214         }
1215         hp = gethostbyname(str);
1216         if (hp != NULL) {
1217                 *hpp = hp;
1218                 su->sin.sin_family = hp->h_addrtype;
1219                 memmove((char *)&su->sin.sin_addr, hp->h_addr,
1220                     MIN((size_t)hp->h_length, sizeof(su->sin.sin_addr)));
1221                 return(1);
1222         }
1223         errx(EX_NOHOST, "bad address: %s", str);
1224 }
1225
1226 static int
1227 prefixlen(const char *len_str)
1228 {
1229         int len = atoi(len_str), q, r;
1230         int max;
1231         char *p;
1232
1233         rtm_addrs |= RTA_NETMASK;       
1234         switch (af) {
1235 #ifdef INET6
1236         case AF_INET6:
1237                 max = 128;
1238                 p = (char *)&so_mask.sin6.sin6_addr;
1239                 break;
1240 #endif
1241         case AF_INET:
1242                 max = 32;
1243                 p = (char *)&so_mask.sin.sin_addr;
1244                 break;
1245         default:
1246                 fprintf(stderr, "prefixlen not supported in this af\n");
1247                 exit(1);
1248                 /*NOTREACHED*/
1249         }
1250
1251         if (len < 0 || max < len) {
1252                 fprintf(stderr, "%s: bad value\n", len_str);
1253                 exit(1);
1254         }
1255         
1256         q = len >> 3;
1257         r = len & 7;
1258         so_mask.sa.sa_family = af;
1259         so_mask.sa.sa_len = aflen;
1260         memset((void *)p, 0, max / 8);
1261         if (q > 0)
1262                 memset((void *)p, 0xff, q);
1263         if (r > 0)
1264                 *((u_char *)p + q) = (0xff00 >> r) & 0xff;
1265         if (len == max)
1266                 return(-1);
1267         else
1268                 return(len);
1269 }
1270
1271 #ifdef NS
1272 short ns_nullh[] = {0,0,0};
1273
1274 char *
1275 ns_print(struct sockaddr_ns *sns)
1276 {
1277         struct ns_addr work;
1278         union { union ns_net net_e; u_long long_e; } net;
1279         u_short port;
1280         static char mybuf[50+MAXHOSTNAMELEN], cport[10], chost[25];
1281         const char *host = "";
1282         char *p;
1283         u_char *q;
1284
1285         work = sns->sns_addr;
1286         port = ntohs(work.x_port);
1287         work.x_port = 0;
1288         net.net_e  = work.x_net;
1289         if (ns_nullhost(work) && net.long_e == 0) {
1290                 if (port == 0)
1291                         strncpy(mybuf, "*.*", sizeof(mybuf));
1292                 else
1293                         sprintf(mybuf, "*.%XH", port);
1294                 return(mybuf);
1295         }
1296
1297         if (memcmp(ns_bh, work.x_host.c_host, 6) == 0)
1298                 host = "any";
1299         else if (memcmp(ns_nullh, work.x_host.c_host, 6) == 0)
1300                 host = "*";
1301         else {
1302                 q = work.x_host.c_host;
1303                 sprintf(chost, "%02X%02X%02X%02X%02X%02XH",
1304                         q[0], q[1], q[2], q[3], q[4], q[5]);
1305                 for (p = chost; *p == '0' && p < chost + 12; p++)
1306                         /* void */;
1307                 host = p;
1308         }
1309         if (port != 0)
1310                 sprintf(cport, ".%XH", htons(port));
1311         else
1312                 *cport = 0;
1313
1314         snprintf(mybuf, sizeof(mybuf), "%lxH.%s%s",
1315                         (unsigned long)ntohl(net.long_e),
1316                         host, cport);
1317         return(mybuf);
1318 }
1319 #endif
1320
1321 static void
1322 interfaces(void)
1323 {
1324         size_t needed;
1325         int mib[6];
1326         char *buf, *lim, *next;
1327         struct rt_msghdr *rtm;
1328
1329         mib[0] = CTL_NET;
1330         mib[1] = PF_ROUTE;
1331         mib[2] = 0;             /* protocol */
1332         mib[3] = 0;             /* wildcard address family */
1333         mib[4] = NET_RT_IFLIST;
1334         mib[5] = 0;             /* no flags */
1335         if (sysctl(mib, 6, NULL, &needed, NULL, 0) < 0)
1336                 err(EX_OSERR, "route-sysctl-estimate");
1337         if ((buf = malloc(needed)) == NULL)
1338                 errx(EX_OSERR, "malloc failed");
1339         if (sysctl(mib, 6, buf, &needed, NULL, 0) < 0)
1340                 err(EX_OSERR, "actual retrieval of interface table");
1341         lim = buf + needed;
1342         for (next = buf; next < lim; next += rtm->rtm_msglen) {
1343                 rtm = (struct rt_msghdr *)next;
1344                 print_rtmsg(rtm, rtm->rtm_msglen);
1345         }
1346 }
1347
1348 static void
1349 monitor(void)
1350 {
1351         int n;
1352         char msg[2048];
1353
1354         verbose = 1;
1355         if (debugonly) {
1356                 interfaces();
1357                 exit(0);
1358         }
1359         for (;;) {
1360                 time_t now;
1361                 n = read(s, msg, 2048);
1362                 now = time(NULL);
1363                 printf("\ngot message of size %d on %s", n, ctime(&now));
1364                 print_rtmsg((struct rt_msghdr *)msg, n);
1365         }
1366 }
1367
1368 struct {
1369         struct  rt_msghdr m_rtm;
1370         char    m_space[512];
1371 } m_rtmsg;
1372
1373 static int
1374 rtmsg(int cmd, int flags)
1375 {
1376         static int seq;
1377         int rlen;
1378         char *cp = m_rtmsg.m_space;
1379         int l;
1380
1381 #define NEXTADDR(w, u) \
1382         if (rtm_addrs & (w)) {\
1383             l = ROUNDUP(u.sa.sa_len); memmove(cp, &(u), l); cp += l;\
1384             if (verbose) sodump(&(u),"u");\
1385         }
1386
1387         errno = 0;
1388         memset(&m_rtmsg, 0, sizeof(m_rtmsg));
1389         if (cmd == 'a')
1390                 cmd = RTM_ADD;
1391         else if (cmd == 'c')
1392                 cmd = RTM_CHANGE;
1393         else if (cmd == 'g') {
1394                 cmd = RTM_GET;
1395                 if (so_ifp.sa.sa_family == 0) {
1396                         so_ifp.sa.sa_family = AF_LINK;
1397                         so_ifp.sa.sa_len = sizeof(struct sockaddr_dl);
1398                         rtm_addrs |= RTA_IFP;
1399                 }
1400         } else
1401                 cmd = RTM_DELETE;
1402 #define rtm m_rtmsg.m_rtm
1403         rtm.rtm_type = cmd;
1404         rtm.rtm_flags = flags;
1405         rtm.rtm_version = RTM_VERSION;
1406         rtm.rtm_seq = ++seq;
1407         rtm.rtm_addrs = rtm_addrs;
1408         rtm.rtm_rmx = rt_metrics;
1409         rtm.rtm_inits = rtm_inits;
1410
1411         if (rtm_addrs & RTA_NETMASK)
1412                 mask_addr();
1413         NEXTADDR(RTA_DST, so_dst);
1414         NEXTADDR(RTA_GATEWAY, so_gate);
1415         NEXTADDR(RTA_NETMASK, so_mask);
1416         NEXTADDR(RTA_GENMASK, so_genmask);
1417         NEXTADDR(RTA_IFP, so_ifp);
1418         NEXTADDR(RTA_IFA, so_ifa);
1419         NEXTADDR(RTA_MPLS1, so_mpls1);
1420         NEXTADDR(RTA_MPLS2, so_mpls2);
1421         NEXTADDR(RTA_MPLS3, so_mpls3);
1422         rtm.rtm_msglen = l = cp - (char *)&m_rtmsg;
1423         if (verbose)
1424                 print_rtmsg(&rtm, l);
1425         if (debugonly)
1426                 return(0);
1427         if ((rlen = write(s, (char *)&m_rtmsg, l)) < 0) {
1428                 warn("writing to routing socket");
1429                 return(-1);
1430         }
1431         if (cmd == RTM_GET) {
1432                 do {
1433                         l = read(s, (char *)&m_rtmsg, sizeof(m_rtmsg));
1434                 } while (l > 0 && (rtm.rtm_seq != seq || rtm.rtm_pid != pid));
1435                 if (l < 0)
1436                         warn("read from routing socket");
1437                 else
1438                         print_getmsg(&rtm, l);
1439         }
1440 #undef rtm
1441         return(0);
1442 }
1443
1444 static void
1445 mask_addr(void)
1446 {
1447         int olen = so_mask.sa.sa_len;
1448         char *cp1 = olen + (char *)&so_mask, *cp2;
1449
1450         for (so_mask.sa.sa_len = 0; cp1 > (char *)&so_mask; )
1451                 if (*--cp1 != 0) {
1452                         so_mask.sa.sa_len = 1 + cp1 - (char *)&so_mask;
1453                         break;
1454                 }
1455         if ((rtm_addrs & RTA_DST) == 0)
1456                 return;
1457         switch (so_dst.sa.sa_family) {
1458 #ifdef NS
1459         case AF_NS:
1460 #endif
1461         case AF_INET:
1462 #ifdef INET6
1463         case AF_INET6:
1464 #endif
1465         case AF_APPLETALK:
1466         case 0:
1467                 return;
1468         }
1469         cp1 = so_mask.sa.sa_len + 1 + (char *)&so_dst;
1470         cp2 = so_dst.sa.sa_len + 1 + (char *)&so_dst;
1471         while (cp2 > cp1)
1472                 *--cp2 = 0;
1473         cp2 = so_mask.sa.sa_len + 1 + (char *)&so_mask;
1474         while (cp1 > so_dst.sa.sa_data)
1475                 *--cp1 &= *--cp2;
1476 }
1477
1478 const char *msgtypes[] = {
1479         "",
1480         "RTM_ADD: Add Route",
1481         "RTM_DELETE: Delete Route",
1482         "RTM_CHANGE: Change Metrics or flags",
1483         "RTM_GET: Report Metrics",
1484         "RTM_LOSING: Kernel Suspects Partitioning",
1485         "RTM_REDIRECT: Told to use different route",
1486         "RTM_MISS: Lookup failed on this address",
1487         "RTM_LOCK: fix specified metrics",
1488         "RTM_OLDADD: caused by SIOCADDRT",
1489         "RTM_OLDDEL: caused by SIOCDELRT",
1490         "RTM_RESOLVE: Route created by cloning",
1491         "RTM_NEWADDR: address being added to iface",
1492         "RTM_DELADDR: address being removed from iface",
1493         "RTM_IFINFO: iface status change",
1494         "RTM_NEWMADDR: new multicast group membership on iface",
1495         "RTM_DELMADDR: multicast group membership removed from iface",
1496         "RTM_IFANNOUNCE: interface arrival/departure",
1497         0,
1498 };
1499
1500 char metricnames[] =
1501 "\011pksent\010rttvar\7rtt\6ssthresh\5sendpipe\4recvpipe\3expire\2hopcount"
1502 "\1mtu";
1503 char routeflags[] =
1504 "\1UP\2GATEWAY\3HOST\4REJECT\5DYNAMIC\6MODIFIED\7DONE\010MASK_PRESENT"
1505 "\011CLONING\012XRESOLVE\013LLINFO\014STATIC\015BLACKHOLE\016b016"
1506 "\017PROTO2\020PROTO1\021PRCLONING\022WASCLONED\023PROTO3\024CHAINDELETE"
1507 "\025PINNED\026LOCAL\027BROADCAST\030MULTICAST";
1508 char ifnetflags[] =
1509 "\1UP\2BROADCAST\3DEBUG\4LOOPBACK\5PTP\6b6\7RUNNING\010NOARP"
1510 "\011PPROMISC\012ALLMULTI\013OACTIVE\014SIMPLEX\015LINK0\016LINK1"
1511 "\017LINK2\020MULTICAST";
1512 char addrnames[] =
1513 "\1DST\2GATEWAY\3NETMASK\4GENMASK\5IFP\6IFA\7AUTHOR\010BRD"
1514 "\011MPLS1\012MPLS2\013MPLS3";
1515
1516 static void
1517 print_rtmsg(struct rt_msghdr *rtm, int msglen __unused)
1518 {
1519         struct if_msghdr *ifm;
1520         struct ifa_msghdr *ifam;
1521 #ifdef RTM_NEWMADDR
1522         struct ifma_msghdr *ifmam;
1523 #endif
1524         struct if_announcemsghdr *ifan;
1525
1526         if (verbose == 0)
1527                 return;
1528         if (rtm->rtm_version != RTM_VERSION) {
1529                 printf("routing message version %d not understood\n",
1530                     rtm->rtm_version);
1531                 return;
1532         }
1533         if (msgtypes[rtm->rtm_type] != NULL)
1534                 printf("%s: ", msgtypes[rtm->rtm_type]);
1535         else
1536                 printf("#%d: ", rtm->rtm_type);
1537         printf("len %d, ", rtm->rtm_msglen);
1538         switch (rtm->rtm_type) {
1539         case RTM_IFINFO:
1540                 ifm = (struct if_msghdr *)rtm;
1541                 printf("if# %d, flags:", ifm->ifm_index);
1542                 bprintf(stdout, ifm->ifm_flags, ifnetflags);
1543                 pmsg_addrs((char *)(ifm + 1), ifm->ifm_addrs);
1544                 break;
1545         case RTM_NEWADDR:
1546         case RTM_DELADDR:
1547                 ifam = (struct ifa_msghdr *)rtm;
1548                 printf("metric %d, flags:", ifam->ifam_metric);
1549                 bprintf(stdout, ifam->ifam_flags, routeflags);
1550                 pmsg_addrs((char *)(ifam + 1), ifam->ifam_addrs);
1551                 break;
1552 #ifdef RTM_NEWMADDR
1553         case RTM_NEWMADDR:
1554         case RTM_DELMADDR:
1555                 ifmam = (struct ifma_msghdr *)rtm;
1556                 pmsg_addrs((char *)(ifmam + 1), ifmam->ifmam_addrs);
1557                 break;
1558 #endif
1559         case RTM_IFANNOUNCE:
1560                 ifan = (struct if_announcemsghdr *)rtm;
1561                 printf("if# %d, what: ", ifan->ifan_index);
1562                 switch (ifan->ifan_what) {
1563                 case IFAN_ARRIVAL:
1564                         printf("arrival");
1565                         break;
1566                 case IFAN_DEPARTURE:
1567                         printf("departure");
1568                         break;
1569                 default:
1570                         printf("#%d", ifan->ifan_what);
1571                         break;
1572                 }
1573                 printf("\n");
1574                 break;
1575
1576         default:
1577                 printf("pid: %ld, seq %d, errno %d, flags:",
1578                         (long)rtm->rtm_pid, rtm->rtm_seq, rtm->rtm_errno);
1579                 bprintf(stdout, rtm->rtm_flags, routeflags);
1580                 pmsg_common(rtm);
1581         }
1582 }
1583
1584 static void
1585 print_getmsg(struct rt_msghdr *rtm, int msglen)
1586 {
1587         struct sockaddr *dst = NULL, *gate = NULL, *mask = NULL;
1588         struct sockaddr_dl *ifp = NULL;
1589         struct sockaddr *sa;
1590         char *cp;
1591         int i;
1592
1593         printf("   route to: %s\n", routename(&so_dst.sa));
1594         if (rtm->rtm_version != RTM_VERSION) {
1595                 warnx("routing message version %d not understood",
1596                      rtm->rtm_version);
1597                 return;
1598         }
1599         if (rtm->rtm_msglen > msglen) {
1600                 warnx("message length mismatch, in packet %d, returned %d",
1601                       rtm->rtm_msglen, msglen);
1602         }
1603         if (rtm->rtm_errno != 0)  {
1604                 errno = rtm->rtm_errno;
1605                 warn("message indicates error %d", errno);
1606                 return;
1607         }
1608         cp = ((char *)(rtm + 1));
1609         if (rtm->rtm_addrs)
1610                 for (i = 1; i != 0; i <<= 1)
1611                         if (i & rtm->rtm_addrs) {
1612                                 sa = (struct sockaddr *)cp;
1613                                 switch (i) {
1614                                 case RTA_DST:
1615                                         dst = sa;
1616                                         break;
1617                                 case RTA_GATEWAY:
1618                                         gate = sa;
1619                                         break;
1620                                 case RTA_NETMASK:
1621                                         mask = sa;
1622                                         break;
1623                                 case RTA_IFP:
1624                                         if (sa->sa_family == AF_LINK &&
1625                                            ((struct sockaddr_dl *)sa)->sdl_nlen)
1626                                                 ifp = (struct sockaddr_dl *)sa;
1627                                         break;
1628                                 }
1629                                 ADVANCE(cp, sa);
1630                         }
1631         if (dst != NULL && mask != NULL)
1632                 mask->sa_family = dst->sa_family;       /* XXX */
1633         if (dst != NULL)
1634                 printf("destination: %s\n", routename(dst));
1635         if (mask != NULL) {
1636                 int savenflag = nflag;
1637
1638                 nflag = 1;
1639                 printf("       mask: %s\n", routename(mask));
1640                 nflag = savenflag;
1641         }
1642         if (gate != NULL && rtm->rtm_flags & RTF_GATEWAY)
1643                 printf("    gateway: %s\n", routename(gate));
1644         if (ifp != NULL)
1645                 printf("  interface: %.*s\n",
1646                     ifp->sdl_nlen, ifp->sdl_data);
1647         printf("      flags: ");
1648         bprintf(stdout, rtm->rtm_flags, routeflags);
1649
1650 #define lock(f) ((rtm->rtm_rmx.rmx_locks & __CONCAT(RTV_,f)) ? 'L' : ' ')
1651 #define msec(u) (((u) + 500) / 1000)            /* usec to msec */
1652
1653         printf("\n%s\n", "\
1654  recvpipe  sendpipe  ssthresh  rtt,msec    rttvar  hopcount      mtu     expire");
1655         printf("%8ld%c ", rtm->rtm_rmx.rmx_recvpipe, lock(RPIPE));
1656         printf("%8ld%c ", rtm->rtm_rmx.rmx_sendpipe, lock(SPIPE));
1657         printf("%8ld%c ", rtm->rtm_rmx.rmx_ssthresh, lock(SSTHRESH));
1658         printf("%8ld%c ", msec(rtm->rtm_rmx.rmx_rtt), lock(RTT));
1659         printf("%8ld%c ", msec(rtm->rtm_rmx.rmx_rttvar), lock(RTTVAR));
1660         printf("%8ld%c ", rtm->rtm_rmx.rmx_hopcount, lock(HOPCOUNT));
1661         printf("%8ld%c ", rtm->rtm_rmx.rmx_mtu, lock(MTU));
1662         if (rtm->rtm_rmx.rmx_expire != 0)
1663                 rtm->rtm_rmx.rmx_expire -= time(0);
1664         printf("%8ld%c\n", rtm->rtm_rmx.rmx_expire, lock(EXPIRE));
1665 #undef lock
1666 #undef msec
1667 #define RTA_IGN (RTA_DST|RTA_GATEWAY|RTA_NETMASK|RTA_IFP|RTA_IFA|RTA_BRD)
1668         if (verbose)
1669                 pmsg_common(rtm);
1670         else if (rtm->rtm_addrs &~ RTA_IGN) {
1671                 printf("sockaddrs: ");
1672                 bprintf(stdout, rtm->rtm_addrs, addrnames);
1673                 putchar('\n');
1674         }
1675 #undef  RTA_IGN
1676 }
1677
1678 static void
1679 pmsg_common(struct rt_msghdr *rtm)
1680 {
1681         printf("\nlocks: ");
1682         bprintf(stdout, rtm->rtm_rmx.rmx_locks, metricnames);
1683         printf(" inits: ");
1684         bprintf(stdout, rtm->rtm_inits, metricnames);
1685         pmsg_addrs(((char *)(rtm + 1)), rtm->rtm_addrs);
1686 }
1687
1688 static void
1689 pmsg_addrs(char *cp, int addrs)
1690 {
1691         struct sockaddr *sa;
1692         int i;
1693
1694         if (addrs == 0) {
1695                 putchar('\n');
1696                 return;
1697         }
1698         printf("\nsockaddrs: ");
1699         bprintf(stdout, addrs, addrnames);
1700         putchar('\n');
1701         for (i = 1; i != 0; i <<= 1)
1702                 if (i & addrs) {
1703                         sa = (struct sockaddr *)cp;
1704                         printf(" %s", routename(sa));
1705                         ADVANCE(cp, sa);
1706                 }
1707         putchar('\n');
1708         fflush(stdout);
1709 }
1710
1711 static void
1712 bprintf(FILE *fp, int b, u_char *str)
1713 {
1714         int i;
1715         int gotsome = 0;
1716
1717         if (b == 0)
1718                 return;
1719         while ((i = *str++) != 0) {
1720                 if (b & (1 << (i-1))) {
1721                         if (!gotsome)
1722                                 i = '<';
1723                         else
1724                                 i = ',';
1725                         putc(i, fp);
1726                         gotsome = 1;
1727                         for (; (i = *str) > 32; str++)
1728                                 putc(i, fp);
1729                 } else
1730                         while (*str > 32)
1731                                 str++;
1732         }
1733         if (gotsome)
1734                 putc('>', fp);
1735 }
1736
1737 int
1738 keyword(const char *cp)
1739 {
1740         struct keytab *kt = keywords;
1741
1742         while (kt->kt_cp != NULL && strcmp(kt->kt_cp, cp) != 0)
1743                 kt++;
1744         return(kt->kt_i);
1745 }
1746
1747 static void
1748 sodump(sup su, const char *which)
1749 {
1750         switch (su->sa.sa_family) {
1751         case AF_LINK:
1752                 printf("%s: link %s; ",
1753                     which, link_ntoa(&su->sdl));
1754                 break;
1755         case AF_INET:
1756                 printf("%s: inet %s; ",
1757                     which, inet_ntoa(su->sin.sin_addr));
1758                 break;
1759         case AF_APPLETALK:
1760                 printf("%s: atalk %s; ",
1761                     which, atalk_ntoa(su->sat.sat_addr));
1762                 break;
1763 #ifdef NS
1764         case AF_NS:
1765                 printf("%s: xns %s; ",
1766                     which, ns_ntoa(su->sns.sns_addr));
1767                 break;
1768 #endif
1769         }
1770         fflush(stdout);
1771 }
1772
1773 /* States*/
1774 #define VIRGIN  0
1775 #define GOTONE  1
1776 #define GOTTWO  2
1777 /* Inputs */
1778 #define DIGIT   (4*0)
1779 #define END     (4*1)
1780 #define DELIM   (4*2)
1781
1782 static void
1783 sockaddr(char *addr, struct sockaddr *sa)
1784 {
1785         char *cp = (char *)sa;
1786         int size = sa->sa_len;
1787         char *cplim = cp + size;
1788         int byte = 0, state = VIRGIN, new = 0 /* foil gcc */;
1789
1790         memset(cp, 0, size);
1791         cp++;
1792         do {
1793                 if ((*addr >= '0') && (*addr <= '9')) {
1794                         new = *addr - '0';
1795                 } else if ((*addr >= 'a') && (*addr <= 'f')) {
1796                         new = *addr - 'a' + 10;
1797                 } else if ((*addr >= 'A') && (*addr <= 'F')) {
1798                         new = *addr - 'A' + 10;
1799                 } else if (*addr == '\0')
1800                         state |= END;
1801                 else
1802                         state |= DELIM;
1803                 addr++;
1804                 switch (state /* | INPUT */) {
1805                 case GOTTWO | DIGIT:
1806                         *cp++ = byte; /*FALLTHROUGH*/
1807                 case VIRGIN | DIGIT:
1808                         state = GOTONE; byte = new; continue;
1809                 case GOTONE | DIGIT:
1810                         state = GOTTWO; byte = new + (byte << 4); continue;
1811                 default: /* | DELIM */
1812                         state = VIRGIN; *cp++ = byte; byte = 0; continue;
1813                 case GOTONE | END:
1814                 case GOTTWO | END:
1815                         *cp++ = byte; /* FALLTHROUGH */
1816                 case VIRGIN | END:
1817                         break;
1818                 }
1819                 break;
1820         } while (cp < cplim);
1821         sa->sa_len = cp - (char *)sa;
1822 }
1823
1824 static int
1825 atalk_aton(const char *text, struct at_addr *addr)
1826 {
1827         u_int net, node;
1828
1829         if (sscanf(text, "%u.%u", &net, &node) != 2
1830             || net > 0xffff || node > 0xff)
1831                 return(0);
1832         addr->s_net = htons(net);
1833         addr->s_node = node;
1834         return(1);
1835 }
1836
1837 static char *
1838 atalk_ntoa(struct at_addr at)
1839 {
1840         static char buf[20];
1841
1842         snprintf(buf, sizeof(buf), "%u.%u", ntohs(at.s_net), at.s_node);
1843         return(buf);
1844 }