route.c revision 1.133 1 /* $NetBSD: route.c,v 1.133 2011/10/07 09:56:15 joerg Exp $ */
2
3 /*
4 * Copyright (c) 1983, 1989, 1991, 1993
5 * The Regents of the University of California. All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
15 * 3. Neither the name of the University nor the names of its contributors
16 * may be used to endorse or promote products derived from this software
17 * without specific prior written permission.
18 *
19 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
20 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
21 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
22 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
23 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
24 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
25 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
26 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
27 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
28 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
29 * SUCH DAMAGE.
30 */
31
32 #include <sys/cdefs.h>
33 #ifndef lint
34 __COPYRIGHT("@(#) Copyright (c) 1983, 1989, 1991, 1993\
35 The Regents of the University of California. All rights reserved.");
36 #endif /* not lint */
37
38 #ifndef lint
39 #if 0
40 static char sccsid[] = "@(#)route.c 8.6 (Berkeley) 4/28/95";
41 #else
42 __RCSID("$NetBSD: route.c,v 1.133 2011/10/07 09:56:15 joerg Exp $");
43 #endif
44 #endif /* not lint */
45
46 #include <sys/param.h>
47 #include <sys/file.h>
48 #include <sys/socket.h>
49 #include <sys/ioctl.h>
50 #include <sys/mbuf.h>
51 #include <sys/sysctl.h>
52
53 #include <net/if.h>
54 #include <net/route.h>
55 #include <net/if_dl.h>
56 #include <net80211/ieee80211_netbsd.h>
57 #include <netinet/in.h>
58 #include <netatalk/at.h>
59 #include <netiso/iso.h>
60 #include <netmpls/mpls.h>
61 #include <arpa/inet.h>
62 #include <netdb.h>
63
64 #include <errno.h>
65 #include <unistd.h>
66 #include <stdio.h>
67 #include <ctype.h>
68 #include <stdlib.h>
69 #include <string.h>
70 #include <time.h>
71 #include <paths.h>
72 #include <err.h>
73
74 #include <rump/rump.h>
75 #include <rump/rump_syscalls.h>
76 #include <rump/rumpclient.h>
77
78 #include "keywords.h"
79 #include "extern.h"
80 #include "prog_ops.h"
81
82 union sockunion {
83 struct sockaddr sa;
84 struct sockaddr_in sin;
85 #ifdef INET6
86 struct sockaddr_in6 sin6;
87 #endif
88 struct sockaddr_at sat;
89 struct sockaddr_dl sdl;
90 #ifndef SMALL
91 struct sockaddr_iso siso;
92 struct sockaddr_mpls smpls;
93 #endif /* SMALL */
94 struct sockaddr_storage sstorage;
95 };
96
97 typedef union sockunion *sup;
98
99 struct sou {
100 union sockunion *so_dst, *so_gate, *so_mask, *so_genmask, *so_ifa,
101 *so_ifp, *so_mpls;
102 };
103
104 static char *any_ntoa(const struct sockaddr *);
105 static const char *route_strerror(int);
106 static void set_metric(const char *, int);
107 static int newroute(int, char *const *);
108 static void inet_makenetandmask(u_int32_t, struct sockaddr_in *, struct sou *);
109 #ifdef INET6
110 static int inet6_makenetandmask(const struct sockaddr_in6 *, struct sou *);
111 #endif
112 static int getaddr(int, const char *, struct hostent **, struct sou *);
113 static int flushroutes(int, char *const [], int);
114 static int prefixlen(const char *, struct sou *);
115 #ifndef SMALL
116 static void interfaces(void);
117 __dead static void monitor(void);
118 static int print_getmsg(struct rt_msghdr *, int, struct sou *);
119 static const char *linkstate(struct if_msghdr *);
120 static sup readtag(sup, const char *);
121 static void addtag(sup, const char *, int);
122 #endif /* SMALL */
123 static int rtmsg(int, int, struct sou *);
124 static void mask_addr(struct sou *);
125 static void print_rtmsg(struct rt_msghdr *, int);
126 static void pmsg_common(struct rt_msghdr *);
127 static void pmsg_addrs(const char *, int);
128 static void bprintf(FILE *, int, const char *);
129 static void sodump(sup, const char *);
130 static void sockaddr(const char *, struct sockaddr *);
131
132 int pid, rtm_addrs;
133 int sock;
134 int forcehost, forcenet, doflush, nflag, af, qflag, tflag, Sflag;
135 int iflag, verbose, aflen = sizeof(struct sockaddr_in), rtag;
136 int locking, lockrest, debugonly, shortoutput;
137 struct rt_metrics rt_metrics;
138 int rtm_inits;
139 short ns_nullh[] = {0,0,0};
140 short ns_bh[] = {-1,-1,-1};
141
142
143 void
144 usage(const char *cp)
145 {
146
147 if (cp)
148 warnx("botched keyword: %s", cp);
149 (void)fprintf(stderr,
150 "Usage: %s [ -fnqSsv ] cmd [[ -<qualifers> ] args ]\n",
151 getprogname());
152 exit(1);
153 /* NOTREACHED */
154 }
155
156 #define PRIETHER "02x:%02x:%02x:%02x:%02x:%02x"
157 #define PRIETHER_ARGS(__enaddr) (__enaddr)[0], (__enaddr)[1], (__enaddr)[2], \
158 (__enaddr)[3], (__enaddr)[4], (__enaddr)[5]
159
160 int
161 main(int argc, char * const *argv)
162 {
163 int ch;
164
165 if (argc < 2)
166 usage(NULL);
167
168 while ((ch = getopt(argc, argv, "dfnqSstv")) != -1)
169 switch (ch) {
170 case 'd':
171 debugonly = 1;
172 break;
173 case 'f':
174 doflush = 1;
175 break;
176 case 'n':
177 nflag = 1;
178 break;
179 case 'q':
180 qflag = 1;
181 break;
182 case 'S':
183 Sflag = 1;
184 break;
185 case 's':
186 shortoutput = 1;
187 break;
188 case 't':
189 tflag = 1;
190 break;
191 case 'v':
192 verbose = 1;
193 break;
194 case '?':
195 default:
196 usage(NULL);
197 /*NOTREACHED*/
198 }
199 argc -= optind;
200 argv += optind;
201
202 if (prog_init && prog_init() == -1)
203 err(1, "init failed");
204
205 pid = prog_getpid();
206 if (tflag)
207 sock = prog_open("/dev/null", O_WRONLY, 0);
208 else
209 sock = prog_socket(PF_ROUTE, SOCK_RAW, 0);
210 if (sock < 0)
211 err(EXIT_FAILURE, "socket");
212
213 if (*argv == NULL) {
214 if (doflush)
215 ch = K_FLUSH;
216 else
217 goto no_cmd;
218 } else
219 ch = keyword(*argv);
220
221 switch (ch) {
222 #ifndef SMALL
223 case K_GET:
224 #endif /* SMALL */
225 case K_CHANGE:
226 case K_ADD:
227 case K_DELETE:
228 if (doflush)
229 (void)flushroutes(1, argv, 0);
230 return newroute(argc, argv);
231
232 case K_SHOW:
233 show(argc, argv);
234 return 0;
235
236 #ifndef SMALL
237 case K_MONITOR:
238 monitor();
239 return 0;
240
241 #endif /* SMALL */
242 case K_FLUSH:
243 return flushroutes(argc, argv, 0);
244
245 case K_FLUSHALL:
246 return flushroutes(argc, argv, 1);
247 no_cmd:
248 default:
249 usage(*argv);
250 /*NOTREACHED*/
251 }
252 }
253
254 /*
255 * Purge all entries in the routing tables not
256 * associated with network interfaces.
257 */
258 static int
259 flushroutes(int argc, char * const argv[], int doall)
260 {
261 struct sockaddr *sa;
262 size_t needed;
263 int flags, mib[6], rlen, seqno;
264 char *buf, *next, *lim;
265 const char *afname;
266 struct rt_msghdr *rtm;
267
268 flags = 0;
269 af = AF_UNSPEC;
270 /* Don't want to read back our messages */
271 prog_shutdown(sock, SHUT_RD);
272 parse_show_opts(argc, argv, &af, &flags, &afname, false);
273 mib[0] = CTL_NET;
274 mib[1] = PF_ROUTE;
275 mib[2] = 0; /* protocol */
276 mib[3] = 0; /* wildcard address family */
277 mib[4] = NET_RT_DUMP;
278 mib[5] = 0; /* no flags */
279 if (prog_sysctl(mib, 6, NULL, &needed, NULL, 0) < 0)
280 err(EXIT_FAILURE, "route-sysctl-estimate");
281 buf = lim = NULL;
282 if (needed) {
283 if ((buf = malloc(needed)) == NULL)
284 err(EXIT_FAILURE, "malloc");
285 if (prog_sysctl(mib, 6, buf, &needed, NULL, 0) < 0)
286 err(EXIT_FAILURE, "actual retrieval of routing table");
287 lim = buf + needed;
288 }
289 if (verbose) {
290 (void)printf("Examining routing table from sysctl\n");
291 if (af != AF_UNSPEC)
292 printf("(address family %s)\n", afname);
293 }
294 if (needed == 0)
295 return 0;
296 seqno = 0; /* ??? */
297 for (next = buf; next < lim; next += rtm->rtm_msglen) {
298 rtm = (struct rt_msghdr *)next;
299 sa = (struct sockaddr *)(rtm + 1);
300 if (verbose)
301 print_rtmsg(rtm, rtm->rtm_msglen);
302 if ((rtm->rtm_flags & flags) != flags)
303 continue;
304 if (!(rtm->rtm_flags & (RTF_GATEWAY | RTF_STATIC |
305 RTF_LLINFO)) && !doall)
306 continue;
307 if (af != AF_UNSPEC && sa->sa_family != af)
308 continue;
309 if (debugonly)
310 continue;
311 rtm->rtm_type = RTM_DELETE;
312 rtm->rtm_seq = seqno;
313 if ((rlen = prog_write(sock, next,
314 rtm->rtm_msglen)) < 0) {
315 warnx("writing to routing socket: %s",
316 route_strerror(errno));
317 return 1;
318 }
319 if (rlen < (int)rtm->rtm_msglen) {
320 warnx("write to routing socket, got %d for rlen", rlen);
321 return 1;
322 }
323 seqno++;
324 if (qflag)
325 continue;
326 if (verbose)
327 print_rtmsg(rtm, rlen);
328 else {
329 (void)printf("%-20.20s ",
330 routename(sa, NULL, rtm->rtm_flags));
331 sa = (struct sockaddr *)(RT_ROUNDUP(sa->sa_len) +
332 (char *)sa);
333 (void)printf("%-20.20s ",
334 routename(sa, NULL, RTF_HOST));
335 (void)printf("done\n");
336 }
337 }
338 free(buf);
339 return 0;
340 }
341
342
343 static char hexlist[] = "0123456789abcdef";
344
345 static char *
346 any_ntoa(const struct sockaddr *sa)
347 {
348 static char obuf[3 * 256];
349 const char *in;
350 char *out;
351 int len;
352
353 #if __GNUC__ > 2
354 len = sa->sa_len - offsetof(struct sockaddr, sa_data);
355 #else
356 len = sa->sa_len - ((struct sockaddr*)&sa->sa_data - sa);
357 #endif
358 in = sa->sa_data;
359 out = obuf;
360
361 do {
362 *out++ = hexlist[(*in >> 4) & 15];
363 *out++ = hexlist[(*in++) & 15];
364 *out++ = '.';
365 } while (--len > 0);
366 out[-1] = '\0';
367 return obuf;
368 }
369
370 int
371 netmask_length(struct sockaddr *nm, int family)
372 {
373 static int
374 /* number of bits in a nibble */
375 _t[] = { 0,1,1,2,1,2,2,3,1,2,2,3,2,3,3,4 },
376 /* good nibbles are 1111, 1110, 1100, 1000, 0000 */
377 _g[] = { 1,0,0,0,0,0,0,0,1,0,0,0,1,0,1,1 };
378 int mask, good, zeroes, maskbytes, bit, i;
379 unsigned char *maskdata;
380
381 if (nm == NULL)
382 return 0;
383
384 mask = 0;
385 good = 1;
386 zeroes = 0;
387
388 switch (family) {
389 case AF_INET: {
390 struct sockaddr_in *nsin = (struct sockaddr_in *)nm;
391 maskdata = (unsigned char *)&nsin->sin_addr;
392 maskbytes = nsin->sin_len -
393 ((caddr_t)&nsin->sin_addr - (caddr_t)nsin);
394 break;
395 }
396 case AF_INET6: {
397 struct sockaddr_in6 *sin6 = (struct sockaddr_in6 *)nm;
398 maskdata = (unsigned char *)&sin6->sin6_addr;
399 maskbytes = sin6->sin6_len -
400 ((caddr_t)&sin6->sin6_addr - (caddr_t)sin6);
401 break;
402 }
403 default:
404 return 0;
405 }
406
407 /*
408 * Count the bits in the nibbles of the mask, and marking the
409 * netmask as not good (or at best, non-standard and very
410 * discouraged, in the case of AF_INET) if we find either of
411 * a nibble with non-contiguous bits, or a non-zero nibble
412 * after we've found a zero nibble.
413 */
414 for (i = 0; i < maskbytes; i++) {
415 /* high nibble */
416 mask += bit = _t[maskdata[i] >> 4];
417 good &= _g[maskdata[i] >> 4];
418 if (zeroes && bit)
419 good = 0;
420 if (bit == 0)
421 zeroes = 1;
422 /* low nibble */
423 mask += bit = _t[maskdata[i] & 0xf];
424 good &= _g[maskdata[i] & 0xf];
425 if (zeroes && bit)
426 good = 0;
427 if (bit == 0)
428 zeroes = 1;
429 }
430
431 /*
432 * Always return the number of bits found, but as a negative
433 * if the mask wasn't one we like.
434 */
435 return good ? mask : -mask;
436 }
437
438 char *
439 netmask_string(const struct sockaddr *mask, int len, int family)
440 {
441 static char smask[INET6_ADDRSTRLEN];
442 struct sockaddr_in nsin;
443 struct sockaddr_in6 nsin6;
444
445 if (len >= 0)
446 snprintf(smask, sizeof(smask), "%d", len);
447 else {
448 switch (family) {
449 case AF_INET:
450 memset(&nsin, 0, sizeof(nsin));
451 memcpy(&nsin, mask, mask->sa_len);
452 snprintf(smask, sizeof(smask), "%s",
453 inet_ntoa(nsin.sin_addr));
454 break;
455 case AF_INET6:
456 memset(&nsin6, 0, sizeof(nsin6));
457 memcpy(&nsin6, mask, mask->sa_len);
458 inet_ntop(family, &nsin6.sin6_addr, smask,
459 sizeof(smask));
460 break;
461 default:
462 snprintf(smask, sizeof(smask), "%s", any_ntoa(mask));
463 }
464 }
465
466 return smask;
467 }
468
469 const char *
470 routename(const struct sockaddr *sa, struct sockaddr *nm, int flags)
471 {
472 const char *cp;
473 static char line[50];
474 struct hostent *hp;
475 static char domain[MAXHOSTNAMELEN + 1];
476 static int first = 1;
477 struct in_addr in;
478 int nml;
479
480 if ((flags & RTF_HOST) == 0)
481 return netname(sa, nm);
482
483 if (first) {
484 first = 0;
485 if (gethostname(domain, MAXHOSTNAMELEN) == 0 &&
486 (cp = strchr(domain, '.')))
487 (void)strlcpy(domain, cp + 1, sizeof(domain));
488 else
489 domain[0] = 0;
490 }
491
492 if (sa->sa_len == 0)
493 strlcpy(line, "default", sizeof(line));
494 else switch (sa->sa_family) {
495
496 case AF_INET:
497 in = ((const struct sockaddr_in *)sa)->sin_addr;
498 nml = netmask_length(nm, AF_INET);
499
500 cp = 0;
501 if (in.s_addr == INADDR_ANY || sa->sa_len < 4) {
502 if (nml == 0)
503 cp = "default";
504 else {
505 static char notdefault[sizeof(NOTDEFSTRING)];
506
507 snprintf(notdefault, sizeof(notdefault),
508 "0.0.0.0/%s",
509 netmask_string(nm, nml, AF_INET));
510 cp = notdefault;
511 }
512 }
513 if (cp == 0 && !nflag) {
514 hp = gethostbyaddr((char *)&in, sizeof(struct in_addr),
515 AF_INET);
516 if (hp) {
517 char *ccp;
518 if ((ccp = strchr(hp->h_name, '.')) &&
519 !strcmp(ccp + 1, domain))
520 *ccp = '\0';
521 cp = hp->h_name;
522 }
523 }
524 if (cp)
525 (void)strlcpy(line, cp, sizeof(line));
526 else
527 (void)strlcpy(line, inet_ntoa(in), sizeof(line));
528 break;
529
530 case AF_LINK:
531 return link_ntoa((const struct sockaddr_dl *)sa);
532
533 #ifdef INET6
534 case AF_INET6:
535 {
536 struct sockaddr_in6 sin6;
537 int niflags;
538 char nihost[NI_MAXHOST];
539
540 niflags = 0;
541 if (nflag)
542 niflags |= NI_NUMERICHOST;
543 memset(&sin6, 0, sizeof(sin6));
544 memcpy(&sin6, sa, sa->sa_len);
545 sin6.sin6_len = sizeof(struct sockaddr_in6);
546 sin6.sin6_family = AF_INET6;
547 #ifdef __KAME__
548 if (sa->sa_len == sizeof(struct sockaddr_in6) &&
549 (IN6_IS_ADDR_LINKLOCAL(&sin6.sin6_addr) ||
550 IN6_IS_ADDR_MC_LINKLOCAL(&sin6.sin6_addr)) &&
551 sin6.sin6_scope_id == 0) {
552 sin6.sin6_scope_id =
553 ntohs(*(u_int16_t *)&sin6.sin6_addr.s6_addr[2]);
554 sin6.sin6_addr.s6_addr[2] = 0;
555 sin6.sin6_addr.s6_addr[3] = 0;
556 }
557 #endif
558 nml = netmask_length(nm, AF_INET6);
559 if (IN6_IS_ADDR_UNSPECIFIED(&sin6.sin6_addr)) {
560 if (nml == 0)
561 strlcpy(line, "::", sizeof(line));
562 else
563 /* noncontiguous never happens in ipv6 */
564 snprintf(line, sizeof(line), "::/%d", nml);
565 }
566 else if (getnameinfo((struct sockaddr *)&sin6, sin6.sin6_len,
567 nihost, sizeof(nihost), NULL, 0, niflags) != 0)
568 strlcpy(line, "invalid", sizeof(line));
569 else {
570 char *ccp;
571 if (!nflag && (ccp = strchr(nihost, '.')) &&
572 strcmp(ccp + 1, domain) == 0)
573 *ccp = '\0';
574 strlcpy(line, nihost, sizeof(line));
575 }
576 break;
577 }
578 #endif
579
580 #ifndef SMALL
581 case AF_ISO:
582 (void)snprintf(line, sizeof line, "iso %s",
583 iso_ntoa(&((const struct sockaddr_iso *)sa)->siso_addr));
584 break;
585
586 case AF_APPLETALK:
587 (void)snprintf(line, sizeof(line), "atalk %d.%d",
588 ((const struct sockaddr_at *)sa)->sat_addr.s_net,
589 ((const struct sockaddr_at *)sa)->sat_addr.s_node);
590 break;
591 case AF_MPLS:
592 {
593 union mpls_shim ms;
594 const union mpls_shim *pms;
595 int psize = sizeof(struct sockaddr_mpls);
596
597 ms.s_addr =((const struct sockaddr_mpls*)sa)->smpls_addr.s_addr;
598 ms.s_addr = ntohl(ms.s_addr);
599
600 snprintf(line, sizeof(line), "%u", ms.shim.label);
601 pms = &((const struct sockaddr_mpls*)sa)->smpls_addr;
602 while(psize < sa->sa_len) {
603 pms++;
604 ms.s_addr = ntohl(pms->s_addr);
605 snprintf(line, sizeof(line), "%s %u", line,
606 ms.shim.label);
607 psize += sizeof(ms);
608 }
609 break;
610 }
611 #endif /* SMALL */
612
613 default:
614 (void)snprintf(line, sizeof line, "(%d) %s",
615 sa->sa_family, any_ntoa(sa));
616 break;
617
618 }
619 return line;
620 }
621
622 /*
623 * Return the name of the network whose address is given.
624 * The address is assumed to be that of a net or subnet, not a host.
625 */
626 const char *
627 netname(const struct sockaddr *sa, struct sockaddr *nm)
628 {
629 const char *cp = 0;
630 static char line[50];
631 struct netent *np = 0;
632 u_int32_t net, mask;
633 u_int32_t i;
634 int subnetshift, nml;
635 struct in_addr in;
636
637 switch (sa->sa_family) {
638
639 case AF_INET:
640 in = ((const struct sockaddr_in *)sa)->sin_addr;
641 i = ntohl(in.s_addr);
642 nml = netmask_length(nm, AF_INET);
643 if (i == 0) {
644 if (nml == 0)
645 cp = "default";
646 else {
647 static char notdefault[sizeof(NOTDEFSTRING)];
648
649 snprintf(notdefault, sizeof(notdefault),
650 "0.0.0.0/%s",
651 netmask_string(nm, nml, AF_INET));
652 cp = notdefault;
653 }
654 }
655 else if (!nflag) {
656 if (IN_CLASSA(i)) {
657 mask = IN_CLASSA_NET;
658 subnetshift = 8;
659 } else if (IN_CLASSB(i)) {
660 mask = IN_CLASSB_NET;
661 subnetshift = 8;
662 } else {
663 mask = IN_CLASSC_NET;
664 subnetshift = 4;
665 }
666 /*
667 * If there are more bits than the standard mask
668 * would suggest, subnets must be in use.
669 * Guess at the subnet mask, assuming reasonable
670 * width subnet fields.
671 */
672 while (i &~ mask)
673 mask = (int32_t)mask >> subnetshift;
674 net = i & mask;
675 while ((mask & 1) == 0)
676 mask >>= 1, net >>= 1;
677 np = getnetbyaddr(net, AF_INET);
678 if (np)
679 cp = np->n_name;
680 }
681 if (cp)
682 (void)strlcpy(line, cp, sizeof(line));
683 else {
684 if (nml == 0)
685 strlcpy(line, inet_ntoa(in), sizeof(line));
686 else if (nml < 0) {
687 snprintf(line, sizeof(line), "%s&%s",
688 inet_ntoa(in),
689 netmask_string(nm, nml, AF_INET));
690 } else {
691 snprintf(line, sizeof(line), "%s/%d",
692 inet_ntoa(in), nml);
693 }
694 }
695 break;
696
697 case AF_LINK:
698 return link_ntoa((const struct sockaddr_dl *)sa);
699
700 #ifdef INET6
701 case AF_INET6:
702 {
703 struct sockaddr_in6 sin6;
704 int niflags;
705
706 niflags = 0;
707 if (nflag)
708 niflags |= NI_NUMERICHOST;
709 memset(&sin6, 0, sizeof(sin6));
710 memcpy(&sin6, sa, sa->sa_len);
711 sin6.sin6_len = sizeof(struct sockaddr_in6);
712 sin6.sin6_family = AF_INET6;
713 #ifdef __KAME__
714 if (sa->sa_len == sizeof(struct sockaddr_in6) &&
715 (IN6_IS_ADDR_LINKLOCAL(&sin6.sin6_addr) ||
716 IN6_IS_ADDR_MC_LINKLOCAL(&sin6.sin6_addr)) &&
717 sin6.sin6_scope_id == 0) {
718 sin6.sin6_scope_id =
719 ntohs(*(u_int16_t *)&sin6.sin6_addr.s6_addr[2]);
720 sin6.sin6_addr.s6_addr[2] = 0;
721 sin6.sin6_addr.s6_addr[3] = 0;
722 }
723 #endif
724 nml = netmask_length(nm, AF_INET6);
725 if (IN6_IS_ADDR_UNSPECIFIED(&sin6.sin6_addr)) {
726 if (nml == 0)
727 strlcpy(line, "::", sizeof(line));
728 else
729 /* noncontiguous never happens in ipv6 */
730 snprintf(line, sizeof(line), "::/%d", nml);
731 }
732 else if (getnameinfo((struct sockaddr *)&sin6, sin6.sin6_len,
733 line, sizeof(line), NULL, 0, niflags) != 0)
734 strlcpy(line, "invalid", sizeof(line));
735 break;
736 }
737 #endif
738
739 #ifndef SMALL
740 case AF_ISO:
741 (void)snprintf(line, sizeof line, "iso %s",
742 iso_ntoa(&((const struct sockaddr_iso *)sa)->siso_addr));
743 break;
744
745 case AF_APPLETALK:
746 (void)snprintf(line, sizeof(line), "atalk %d.%d",
747 ((const struct sockaddr_at *)sa)->sat_addr.s_net,
748 ((const struct sockaddr_at *)sa)->sat_addr.s_node);
749 break;
750 #endif /* SMALL */
751
752 default:
753 (void)snprintf(line, sizeof line, "af %d: %s",
754 sa->sa_family, any_ntoa(sa));
755 break;
756 }
757 return line;
758 }
759
760 static const char *
761 route_strerror(int error)
762 {
763
764 switch (error) {
765 case ESRCH:
766 return "not in table";
767 case EBUSY:
768 return "entry in use";
769 case ENOBUFS:
770 return "routing table overflow";
771 default:
772 return strerror(error);
773 }
774 }
775
776 static void
777 set_metric(const char *value, int key)
778 {
779 int flag = 0;
780 uint64_t noval, *valp = &noval;
781
782 switch (key) {
783 #define caseof(x, y, z) \
784 case x: valp = (uint64_t *)&rt_metrics.z; flag = y; break
785 caseof(K_MTU, RTV_MTU, rmx_mtu);
786 caseof(K_HOPCOUNT, RTV_HOPCOUNT, rmx_hopcount);
787 caseof(K_EXPIRE, RTV_EXPIRE, rmx_expire);
788 caseof(K_RECVPIPE, RTV_RPIPE, rmx_recvpipe);
789 caseof(K_SENDPIPE, RTV_SPIPE, rmx_sendpipe);
790 caseof(K_SSTHRESH, RTV_SSTHRESH, rmx_ssthresh);
791 caseof(K_RTT, RTV_RTT, rmx_rtt);
792 caseof(K_RTTVAR, RTV_RTTVAR, rmx_rttvar);
793 }
794 rtm_inits |= flag;
795 if (lockrest || locking)
796 rt_metrics.rmx_locks |= flag;
797 if (locking)
798 locking = 0;
799 *valp = strtoul(value, NULL, 0);
800 }
801
802 static int
803 newroute(int argc, char *const *argv)
804 {
805 const char *cmd, *dest = "", *gateway = "";
806 int ishost = 0, ret, attempts, oerrno, flags = RTF_STATIC;
807 int key;
808 struct hostent *hp = 0;
809 struct sou sou, *soup = &sou;
810
811 sou.so_dst = calloc(1, sizeof(union sockunion));
812 sou.so_gate = calloc(1, sizeof(union sockunion));
813 sou.so_mask = calloc(1, sizeof(union sockunion));
814 sou.so_genmask = calloc(1, sizeof(union sockunion));
815 sou.so_ifa = calloc(1, sizeof(union sockunion));
816 sou.so_ifp = calloc(1, sizeof(union sockunion));
817 sou.so_mpls = calloc(1, sizeof(union sockunion));
818
819 if (sou.so_dst == NULL || sou.so_gate == NULL || sou.so_mask == NULL ||
820 sou.so_genmask == NULL || sou.so_ifa == NULL || sou.so_ifp == NULL ||
821 sou.so_mpls == NULL)
822 errx(EXIT_FAILURE, "Cannot allocate memory");
823
824 cmd = argv[0];
825 af = AF_UNSPEC;
826 if (*cmd != 'g') {
827 /* Don't want to read back our messages */
828 prog_shutdown(sock, SHUT_RD);
829 }
830 while (--argc > 0) {
831 if (**(++argv)== '-') {
832 switch (key = keyword(1 + *argv)) {
833
834 case K_SA:
835 af = PF_ROUTE;
836 aflen = sizeof(union sockunion);
837 break;
838
839 #ifndef SMALL
840 case K_ATALK:
841 af = AF_APPLETALK;
842 aflen = sizeof(struct sockaddr_at);
843 break;
844 #endif
845
846 case K_INET:
847 af = AF_INET;
848 aflen = sizeof(struct sockaddr_in);
849 break;
850
851 #ifdef INET6
852 case K_INET6:
853 af = AF_INET6;
854 aflen = sizeof(struct sockaddr_in6);
855 break;
856 #endif
857
858 case K_LINK:
859 af = AF_LINK;
860 aflen = sizeof(struct sockaddr_dl);
861 break;
862
863 #ifndef SMALL
864 case K_OSI:
865 case K_ISO:
866 af = AF_ISO;
867 aflen = sizeof(struct sockaddr_iso);
868 break;
869 case K_MPLS:
870 af = AF_MPLS;
871 aflen = sizeof(struct sockaddr_mpls);
872 break;
873 case K_TAG:
874 if (!--argc)
875 usage(1+*argv);
876 af = AF_MPLS;
877 aflen = sizeof(struct sockaddr_mpls);
878 (void)getaddr(RTA_TAG, *++argv, 0, soup);
879 break;
880 #endif /* SMALL */
881
882 case K_IFACE:
883 case K_INTERFACE:
884 iflag++;
885 break;
886 case K_NOSTATIC:
887 flags &= ~RTF_STATIC;
888 break;
889 case K_LLINFO:
890 flags |= RTF_LLINFO;
891 break;
892 case K_LOCK:
893 locking = 1;
894 break;
895 case K_LOCKREST:
896 lockrest = 1;
897 break;
898 case K_HOST:
899 forcehost++;
900 break;
901 case K_REJECT:
902 flags |= RTF_REJECT;
903 break;
904 case K_NOREJECT:
905 flags &= ~RTF_REJECT;
906 break;
907 case K_BLACKHOLE:
908 flags |= RTF_BLACKHOLE;
909 break;
910 case K_NOBLACKHOLE:
911 flags &= ~RTF_BLACKHOLE;
912 break;
913 case K_CLONED:
914 flags |= RTF_CLONED;
915 break;
916 case K_NOCLONED:
917 flags &= ~RTF_CLONED;
918 break;
919 case K_PROTO1:
920 flags |= RTF_PROTO1;
921 break;
922 case K_PROTO2:
923 flags |= RTF_PROTO2;
924 break;
925 case K_CLONING:
926 flags |= RTF_CLONING;
927 break;
928 case K_NOCLONING:
929 flags &= ~RTF_CLONING;
930 break;
931 case K_XRESOLVE:
932 flags |= RTF_XRESOLVE;
933 break;
934 case K_STATIC:
935 flags |= RTF_STATIC;
936 break;
937 case K_IFA:
938 if (!--argc)
939 usage(1+*argv);
940 (void)getaddr(RTA_IFA, *++argv, 0, soup);
941 break;
942 case K_IFP:
943 if (!--argc)
944 usage(1+*argv);
945 (void)getaddr(RTA_IFP, *++argv, 0, soup);
946 break;
947 case K_GENMASK:
948 if (!--argc)
949 usage(1+*argv);
950 (void)getaddr(RTA_GENMASK, *++argv, 0, soup);
951 break;
952 case K_GATEWAY:
953 if (!--argc)
954 usage(1+*argv);
955 (void)getaddr(RTA_GATEWAY, *++argv, 0, soup);
956 break;
957 case K_DST:
958 if (!--argc)
959 usage(1+*argv);
960 ishost = getaddr(RTA_DST, *++argv, &hp, soup);
961 dest = *argv;
962 break;
963 case K_NETMASK:
964 if (!--argc)
965 usage(1+*argv);
966 (void)getaddr(RTA_NETMASK, *++argv, 0, soup);
967 /* FALLTHROUGH */
968 case K_NET:
969 forcenet++;
970 break;
971 case K_PREFIXLEN:
972 if (!--argc)
973 usage(1+*argv);
974 ishost = prefixlen(*++argv, soup);
975 break;
976 case K_MTU:
977 case K_HOPCOUNT:
978 case K_EXPIRE:
979 case K_RECVPIPE:
980 case K_SENDPIPE:
981 case K_SSTHRESH:
982 case K_RTT:
983 case K_RTTVAR:
984 if (!--argc)
985 usage(1+*argv);
986 set_metric(*++argv, key);
987 break;
988 default:
989 usage(1+*argv);
990 }
991 } else {
992 if ((rtm_addrs & RTA_DST) == 0) {
993 dest = *argv;
994 ishost = getaddr(RTA_DST, *argv, &hp, soup);
995 } else if ((rtm_addrs & RTA_GATEWAY) == 0) {
996 gateway = *argv;
997 (void)getaddr(RTA_GATEWAY, *argv, &hp, soup);
998 } else {
999 ret = atoi(*argv);
1000
1001 if (ret == 0) {
1002 if (strcmp(*argv, "0") == 0) {
1003 if (!qflag) {
1004 warnx("%s, %s",
1005 "old usage of trailing 0",
1006 "assuming route to if");
1007 }
1008 } else
1009 usage(NULL);
1010 iflag = 1;
1011 continue;
1012 } else if (ret > 0 && ret < 10) {
1013 if (!qflag) {
1014 warnx("%s, %s",
1015 "old usage of trailing digit",
1016 "assuming route via gateway");
1017 }
1018 iflag = 0;
1019 continue;
1020 }
1021 (void)getaddr(RTA_NETMASK, *argv, 0, soup);
1022 }
1023 }
1024 }
1025 if (forcehost && forcenet)
1026 errx(EXIT_FAILURE, "-host and -net conflict");
1027 else if (forcehost)
1028 ishost = 1;
1029 else if (forcenet)
1030 ishost = 0;
1031 flags |= RTF_UP;
1032 if (ishost)
1033 flags |= RTF_HOST;
1034 if (iflag == 0)
1035 flags |= RTF_GATEWAY;
1036 for (attempts = 1; ; attempts++) {
1037 errno = 0;
1038 if ((ret = rtmsg(*cmd, flags, soup)) == 0)
1039 break;
1040 if (errno != ENETUNREACH && errno != ESRCH)
1041 break;
1042 if (af == AF_INET && *gateway && hp && hp->h_addr_list[1]) {
1043 hp->h_addr_list++;
1044 memmove(&soup->so_gate->sin.sin_addr, hp->h_addr_list[0],
1045 hp->h_length);
1046 } else
1047 break;
1048 }
1049 if (*cmd == 'g')
1050 return ret != 0;
1051 if (!qflag) {
1052 oerrno = errno;
1053 (void)printf("%s %s %s", cmd, ishost? "host" : "net", dest);
1054 if (*gateway) {
1055 (void)printf(": gateway %s", gateway);
1056 if (attempts > 1 && ret == 0 && af == AF_INET)
1057 (void)printf(" (%s)",
1058 inet_ntoa(soup->so_gate->sin.sin_addr));
1059 }
1060 if (ret == 0)
1061 (void)printf("\n");
1062 else
1063 (void)printf(": %s\n", route_strerror(oerrno));
1064 }
1065 free(sou.so_dst);
1066 free(sou.so_gate);
1067 free(sou.so_mask);
1068 free(sou.so_genmask);
1069 free(sou.so_ifa);
1070 free(sou.so_ifp);
1071 free(sou.so_mpls);
1072
1073 return ret != 0;
1074 }
1075
1076 static void
1077 inet_makenetandmask(const u_int32_t net, struct sockaddr_in * const isin,
1078 struct sou *soup)
1079 {
1080 struct sockaddr_in *sin;
1081 u_int32_t addr, mask = 0;
1082 char *cp;
1083
1084 rtm_addrs |= RTA_NETMASK;
1085 if (net == 0)
1086 mask = addr = 0;
1087 else if (net < 128) {
1088 addr = net << IN_CLASSA_NSHIFT;
1089 mask = IN_CLASSA_NET;
1090 } else if (net < 192) {
1091 addr = net << IN_CLASSA_NSHIFT;
1092 mask = IN_CLASSB_NET;
1093 } else if (net < 224) {
1094 addr = net << IN_CLASSA_NSHIFT;
1095 mask = IN_CLASSC_NET;
1096 } else if (net < 256) {
1097 addr = net << IN_CLASSA_NSHIFT;
1098 mask = IN_CLASSD_NET;
1099 } else if (net < 49152) { /* 192 * 256 */
1100 addr = net << IN_CLASSB_NSHIFT;
1101 mask = IN_CLASSB_NET;
1102 } else if (net < 57344) { /* 224 * 256 */
1103 addr = net << IN_CLASSB_NSHIFT;
1104 mask = IN_CLASSC_NET;
1105 } else if (net < 65536) {
1106 addr = net << IN_CLASSB_NSHIFT;
1107 mask = IN_CLASSB_NET;
1108 } else if (net < 14680064L) { /* 224 * 65536 */
1109 addr = net << IN_CLASSC_NSHIFT;
1110 mask = IN_CLASSC_NET;
1111 } else if (net < 16777216L) {
1112 addr = net << IN_CLASSC_NSHIFT;
1113 mask = IN_CLASSD_NET;
1114 } else {
1115 addr = net;
1116 if ((addr & IN_CLASSA_HOST) == 0)
1117 mask = IN_CLASSA_NET;
1118 else if ((addr & IN_CLASSB_HOST) == 0)
1119 mask = IN_CLASSB_NET;
1120 else if ((addr & IN_CLASSC_HOST) == 0)
1121 mask = IN_CLASSC_NET;
1122 else
1123 mask = -1;
1124 }
1125 isin->sin_addr.s_addr = htonl(addr);
1126 sin = &soup->so_mask->sin;
1127 sin->sin_addr.s_addr = htonl(mask);
1128 sin->sin_len = 0;
1129 sin->sin_family = 0;
1130 cp = (char *)(&sin->sin_addr + 1);
1131 while (*--cp == 0 && cp > (char *)sin)
1132 ;
1133 sin->sin_len = 1 + cp - (char *)sin;
1134 sin->sin_family = AF_INET;
1135 }
1136
1137 #ifdef INET6
1138 /*
1139 * XXX the function may need more improvement...
1140 */
1141 static int
1142 inet6_makenetandmask(const struct sockaddr_in6 * const sin6, struct sou *soup)
1143 {
1144 const char *plen;
1145 struct in6_addr in6;
1146
1147 plen = NULL;
1148 if (IN6_IS_ADDR_UNSPECIFIED(&sin6->sin6_addr) &&
1149 sin6->sin6_scope_id == 0) {
1150 plen = "0";
1151 } else if ((sin6->sin6_addr.s6_addr[0] & 0xe0) == 0x20) {
1152 /* aggregatable global unicast - RFC2374 */
1153 memset(&in6, 0, sizeof(in6));
1154 if (!memcmp(&sin6->sin6_addr.s6_addr[8], &in6.s6_addr[8], 8))
1155 plen = "64";
1156 }
1157
1158 if (!plen || strcmp(plen, "128") == 0)
1159 return 1;
1160 else {
1161 rtm_addrs |= RTA_NETMASK;
1162 (void)prefixlen(plen, soup);
1163 return 0;
1164 }
1165 }
1166 #endif
1167
1168 /*
1169 * Interpret an argument as a network address of some kind,
1170 * returning 1 if a host address, 0 if a network address.
1171 */
1172 static int
1173 getaddr(int which, const char *s, struct hostent **hpp, struct sou *soup)
1174 {
1175 sup su;
1176 struct hostent *hp;
1177 struct netent *np;
1178 u_int32_t val;
1179 char *t;
1180 int afamily; /* local copy of af so we can change it */
1181
1182 if (af == AF_UNSPEC) {
1183 af = AF_INET;
1184 aflen = sizeof(struct sockaddr_in);
1185 }
1186 afamily = af;
1187 rtm_addrs |= which;
1188 switch (which) {
1189 case RTA_DST:
1190 su = soup->so_dst;
1191 break;
1192 case RTA_GATEWAY:
1193 su = soup->so_gate;
1194 break;
1195 case RTA_NETMASK:
1196 su = soup->so_mask;
1197 break;
1198 case RTA_GENMASK:
1199 su = soup->so_genmask;
1200 break;
1201 case RTA_IFP:
1202 su = soup->so_ifp;
1203 afamily = AF_LINK;
1204 break;
1205 case RTA_IFA:
1206 su = soup->so_ifa;
1207 su->sa.sa_family = af;
1208 break;
1209 #ifndef SMALL
1210 case RTA_TAG:
1211 su = soup->so_mpls;
1212 afamily = AF_MPLS;
1213 break;
1214 #endif
1215 default:
1216 su = NULL;
1217 usage("Internal Error");
1218 /*NOTREACHED*/
1219 }
1220 su->sa.sa_len = aflen;
1221 su->sa.sa_family = afamily; /* cases that don't want it have left already */
1222 if (strcmp(s, "default") == 0) {
1223 switch (which) {
1224 case RTA_DST:
1225 forcenet++;
1226 (void)getaddr(RTA_NETMASK, s, 0, soup);
1227 break;
1228 case RTA_NETMASK:
1229 case RTA_GENMASK:
1230 su->sa.sa_len = 0;
1231 }
1232 return 0;
1233 }
1234 switch (afamily) {
1235 #ifdef INET6
1236 case AF_INET6:
1237 {
1238 struct addrinfo hints, *res;
1239 char *slash = 0;
1240
1241 if (which == RTA_DST && (slash = (strrchr(s, '/'))) != 0)
1242 *slash = '\0';
1243 memset(&hints, 0, sizeof(hints));
1244 hints.ai_family = afamily; /*AF_INET6*/
1245 hints.ai_flags = AI_NUMERICHOST;
1246 hints.ai_socktype = SOCK_DGRAM; /*dummy*/
1247 if (getaddrinfo(s, "0", &hints, &res) != 0) {
1248 hints.ai_flags = 0;
1249 if (slash) {
1250 *slash = '/';
1251 slash = 0;
1252 }
1253 if (getaddrinfo(s, "0", &hints, &res) != 0)
1254 errx(EXIT_FAILURE, "%s: bad value", s);
1255 }
1256 if (slash)
1257 *slash = '/';
1258 if (sizeof(su->sin6) != res->ai_addrlen)
1259 errx(EXIT_FAILURE, "%s: bad value", s);
1260 if (res->ai_next) {
1261 errx(EXIT_FAILURE,
1262 "%s: address resolved to multiple values", s);
1263 }
1264 memcpy(&su->sin6, res->ai_addr, sizeof(su->sin6));
1265 freeaddrinfo(res);
1266 #ifdef __KAME__
1267 if ((IN6_IS_ADDR_LINKLOCAL(&su->sin6.sin6_addr) ||
1268 IN6_IS_ADDR_MC_LINKLOCAL(&su->sin6.sin6_addr)) &&
1269 su->sin6.sin6_scope_id) {
1270 *(u_int16_t *)&su->sin6.sin6_addr.s6_addr[2] =
1271 htons(su->sin6.sin6_scope_id);
1272 su->sin6.sin6_scope_id = 0;
1273 }
1274 #endif
1275 if (hints.ai_flags == AI_NUMERICHOST) {
1276 if (slash)
1277 return prefixlen(slash + 1, soup);
1278 if (which == RTA_DST)
1279 return inet6_makenetandmask(&su->sin6, soup);
1280 return 0;
1281 } else
1282 return 1;
1283 }
1284 #endif
1285
1286 #ifndef SMALL
1287 case AF_OSI:
1288 su->siso.siso_addr = *iso_addr(s);
1289 if (which == RTA_NETMASK || which == RTA_GENMASK) {
1290 const char *cp = TSEL(&su->siso);
1291 su->siso.siso_nlen = 0;
1292 do {--cp ;} while ((cp > (char *)su) && (*cp == 0));
1293 su->siso.siso_len = 1 + cp - (char *)su;
1294 }
1295 return 1;
1296 #endif /* SMALL */
1297
1298 case PF_ROUTE:
1299 su->sa.sa_len = sizeof(*su);
1300 sockaddr(s, &su->sa);
1301 return 1;
1302
1303 #ifndef SMALL
1304 case AF_APPLETALK:
1305 t = strchr (s, '.');
1306 if (!t) {
1307 badataddr:
1308 errx(EXIT_FAILURE, "bad address: %s", s);
1309 }
1310 val = atoi (s);
1311 if (val > 65535)
1312 goto badataddr;
1313 su->sat.sat_addr.s_net = val;
1314 val = atoi (t);
1315 if (val > 256)
1316 goto badataddr;
1317 su->sat.sat_addr.s_node = val;
1318 rtm_addrs |= RTA_NETMASK;
1319 return(forcehost || su->sat.sat_addr.s_node != 0);
1320 case AF_MPLS:
1321 if (which == RTA_DST)
1322 soup->so_dst = readtag(su, s);
1323 else if (which == RTA_TAG)
1324 soup->so_mpls = readtag(su, s);
1325 else
1326 errx(EXIT_FAILURE, "MPLS can be used only as "
1327 "DST or TAG");
1328 return 1;
1329 #endif
1330
1331 case AF_LINK:
1332 link_addr(s, &su->sdl);
1333 return 1;
1334
1335 case AF_INET:
1336 default:
1337 break;
1338 }
1339
1340 if (hpp == NULL)
1341 hpp = &hp;
1342 *hpp = NULL;
1343
1344 if ((t = strchr(s, '/')) != NULL && which == RTA_DST) {
1345 *t = '\0';
1346 if (forcenet == 0) {
1347 if ((val = inet_addr(s)) != INADDR_NONE) {
1348 inet_makenetandmask(htonl(val), &su->sin, soup);
1349 return prefixlen(&t[1], soup);
1350 }
1351 } else {
1352 if ((val = inet_network(s)) != INADDR_NONE) {
1353 inet_makenetandmask(val, &su->sin, soup);
1354 return prefixlen(&t[1], soup);
1355 }
1356 }
1357 *t = '/';
1358 }
1359 if (inet_aton(s, &su->sin.sin_addr) &&
1360 (which != RTA_DST || forcenet == 0)) {
1361 val = su->sin.sin_addr.s_addr;
1362 if (inet_lnaof(su->sin.sin_addr) != INADDR_ANY)
1363 return 1;
1364 else {
1365 val = ntohl(val);
1366 goto netdone;
1367 }
1368 }
1369 if ((val = inet_network(s)) != INADDR_NONE ||
1370 ((np = getnetbyname(s)) != NULL && (val = np->n_net) != 0)) {
1371 netdone:
1372 if (which == RTA_DST)
1373 inet_makenetandmask(val, &su->sin, soup);
1374 return 0;
1375 }
1376 hp = gethostbyname(s);
1377 if (hp) {
1378 *hpp = hp;
1379 su->sin.sin_family = hp->h_addrtype;
1380 memmove(&su->sin.sin_addr, hp->h_addr, hp->h_length);
1381 return 1;
1382 }
1383 errx(EXIT_FAILURE, "%s: bad value", s);
1384 /*NOTREACHED*/
1385 }
1386
1387 #ifndef SMALL
1388 static sup
1389 readtag(sup su, const char *s)
1390 {
1391 char *p, *n, *norig;
1392 int mplssize = 0;
1393 sup retsu = su;
1394
1395 n = strdup(s);
1396 if (n == NULL)
1397 errx(EXIT_FAILURE, "%s: Cannot allocate memory", s);
1398 norig = n;
1399 for (uint i = 0; i < strlen(n); i++)
1400 if(n[i] == ',')
1401 mplssize++;
1402
1403 #define MPLS_NEW_SIZE (sizeof(struct sockaddr_mpls) + \
1404 mplssize * sizeof(union mpls_shim))
1405
1406 if (mplssize != 0 && sizeof(union sockunion) < MPLS_NEW_SIZE) {
1407 free(su);
1408 retsu = malloc(MPLS_NEW_SIZE);
1409 retsu->smpls.smpls_family = AF_MPLS;
1410 }
1411 retsu->smpls.smpls_len = MPLS_NEW_SIZE;
1412 mplssize = 0;
1413 while ((p = strchr(n, ',')) != NULL) {
1414 p[0] = '\0';
1415 addtag(retsu, n, mplssize);
1416 n = p + 1;
1417 mplssize++;
1418 }
1419 addtag(retsu, n, mplssize);
1420
1421 free(norig);
1422 return retsu;
1423 }
1424
1425 static void
1426 addtag(sup su, const char *s, int where)
1427 {
1428 union mpls_shim *ms = &su->smpls.smpls_addr;
1429
1430 if (atoi(s) < 0 || atoi(s) >= (1 << 20))
1431 errx(EXIT_FAILURE, "%s: Bad tag", s);
1432 ms[where].s_addr = 0;
1433 ms[where].shim.label = atoi(s);
1434 ms[where].s_addr = htonl(ms[where].s_addr);
1435 }
1436 #endif /* SMALL */
1437
1438 int
1439 prefixlen(const char *s, struct sou *soup)
1440 {
1441 int len = atoi(s), q, r;
1442 int max;
1443
1444 switch (af) {
1445 case AF_INET:
1446 max = sizeof(struct in_addr) * 8;
1447 break;
1448 #ifdef INET6
1449 case AF_INET6:
1450 max = sizeof(struct in6_addr) * 8;
1451 break;
1452 #endif
1453 default:
1454 errx(EXIT_FAILURE, "prefixlen is not supported with af %d", af);
1455 /*NOTREACHED*/
1456 }
1457
1458 rtm_addrs |= RTA_NETMASK;
1459 if (len < -1 || len > max)
1460 errx(EXIT_FAILURE, "%s: bad value", s);
1461
1462 q = len >> 3;
1463 r = len & 7;
1464 switch (af) {
1465 case AF_INET:
1466 memset(soup->so_mask, 0, sizeof(*soup->so_mask));
1467 soup->so_mask->sin.sin_family = AF_INET;
1468 soup->so_mask->sin.sin_len = sizeof(struct sockaddr_in);
1469 soup->so_mask->sin.sin_addr.s_addr = (len == 0 ? 0
1470 : htonl(0xffffffff << (32 - len)));
1471 break;
1472 #ifdef INET6
1473 case AF_INET6:
1474 soup->so_mask->sin6.sin6_family = AF_INET6;
1475 soup->so_mask->sin6.sin6_len = sizeof(struct sockaddr_in6);
1476 memset(&soup->so_mask->sin6.sin6_addr, 0,
1477 sizeof(soup->so_mask->sin6.sin6_addr));
1478 if (q > 0)
1479 memset(&soup->so_mask->sin6.sin6_addr, 0xff, q);
1480 if (r > 0)
1481 *((u_char *)&soup->so_mask->sin6.sin6_addr + q) =
1482 (0xff00 >> r) & 0xff;
1483 break;
1484 #endif
1485 }
1486 return len == max;
1487 }
1488
1489 #ifndef SMALL
1490 static void
1491 interfaces(void)
1492 {
1493 size_t needed;
1494 int mib[6];
1495 char *buf, *lim, *next;
1496 struct rt_msghdr *rtm;
1497
1498 mib[0] = CTL_NET;
1499 mib[1] = PF_ROUTE;
1500 mib[2] = 0; /* protocol */
1501 mib[3] = 0; /* wildcard address family */
1502 mib[4] = NET_RT_IFLIST;
1503 mib[5] = 0; /* no flags */
1504 if (prog_sysctl(mib, 6, NULL, &needed, NULL, 0) < 0)
1505 err(EXIT_FAILURE, "route-sysctl-estimate");
1506 if (needed) {
1507 if ((buf = malloc(needed)) == NULL)
1508 err(EXIT_FAILURE, "malloc");
1509 if (prog_sysctl(mib, 6, buf, &needed, NULL, 0) < 0) {
1510 err(EXIT_FAILURE,
1511 "actual retrieval of interface table");
1512 }
1513 lim = buf + needed;
1514 for (next = buf; next < lim; next += rtm->rtm_msglen) {
1515 rtm = (struct rt_msghdr *)next;
1516 print_rtmsg(rtm, rtm->rtm_msglen);
1517 }
1518 free(buf);
1519 }
1520 }
1521
1522 static void
1523 monitor(void)
1524 {
1525 int n;
1526 union {
1527 char msg[2048];
1528 struct rt_msghdr hdr;
1529 } u;
1530
1531 verbose = 1;
1532 if (debugonly) {
1533 interfaces();
1534 exit(0);
1535 }
1536 for(;;) {
1537 time_t now;
1538 n = prog_read(sock, &u, sizeof(u));
1539 now = time(NULL);
1540 (void)printf("got message of size %d on %s", n, ctime(&now));
1541 print_rtmsg(&u.hdr, n);
1542 }
1543 }
1544
1545 #endif /* SMALL */
1546
1547
1548 struct {
1549 struct rt_msghdr m_rtm;
1550 char m_space[512];
1551 } m_rtmsg;
1552
1553 static int
1554 rtmsg(int cmd, int flags, struct sou *soup)
1555 {
1556 static int seq;
1557 int rlen;
1558 char *cp = m_rtmsg.m_space;
1559 int l;
1560
1561 #define NEXTADDR(w, u) \
1562 if (rtm_addrs & (w)) {\
1563 l = RT_ROUNDUP(u->sa.sa_len); memmove(cp, u, l); cp += l;\
1564 if (verbose && ! shortoutput) sodump(u,#u);\
1565 }
1566
1567 errno = 0;
1568 memset(&m_rtmsg, 0, sizeof(m_rtmsg));
1569 if (cmd == 'a')
1570 cmd = RTM_ADD;
1571 else if (cmd == 'c')
1572 cmd = RTM_CHANGE;
1573 else if (cmd == 'g') {
1574 #ifdef SMALL
1575 return -1;
1576 #else /* SMALL */
1577 cmd = RTM_GET;
1578 if (soup->so_ifp->sa.sa_family == AF_UNSPEC) {
1579 soup->so_ifp->sa.sa_family = AF_LINK;
1580 soup->so_ifp->sa.sa_len = sizeof(struct sockaddr_dl);
1581 rtm_addrs |= RTA_IFP;
1582 }
1583 #endif /* SMALL */
1584 } else
1585 cmd = RTM_DELETE;
1586 #define rtm m_rtmsg.m_rtm
1587 rtm.rtm_type = cmd;
1588 rtm.rtm_flags = flags;
1589 rtm.rtm_version = RTM_VERSION;
1590 rtm.rtm_seq = ++seq;
1591 rtm.rtm_addrs = rtm_addrs;
1592 rtm.rtm_rmx = rt_metrics;
1593 rtm.rtm_inits = rtm_inits;
1594
1595 if (rtm_addrs & RTA_NETMASK)
1596 mask_addr(soup);
1597 NEXTADDR(RTA_DST, soup->so_dst);
1598 NEXTADDR(RTA_GATEWAY, soup->so_gate);
1599 NEXTADDR(RTA_NETMASK, soup->so_mask);
1600 NEXTADDR(RTA_GENMASK, soup->so_genmask);
1601 NEXTADDR(RTA_IFP, soup->so_ifp);
1602 NEXTADDR(RTA_IFA, soup->so_ifa);
1603 #ifndef SMALL
1604 NEXTADDR(RTA_TAG, soup->so_mpls);
1605 #endif
1606 rtm.rtm_msglen = l = cp - (char *)&m_rtmsg;
1607 if (verbose && ! shortoutput) {
1608 if (rtm_addrs)
1609 putchar('\n');
1610 print_rtmsg(&rtm, l);
1611 }
1612 if (debugonly)
1613 return 0;
1614 if ((rlen = prog_write(sock, (char *)&m_rtmsg, l)) < 0) {
1615 warnx("writing to routing socket: %s", route_strerror(errno));
1616 return -1;
1617 }
1618 if (rlen < l) {
1619 warnx("write to routing socket, got %d for rlen", rlen);
1620 return 1;
1621 }
1622 #ifndef SMALL
1623 if (cmd == RTM_GET) {
1624 do {
1625 l = prog_read(sock,
1626 (char *)&m_rtmsg, sizeof(m_rtmsg));
1627 } while (l > 0 && (rtm.rtm_seq != seq || rtm.rtm_pid != pid));
1628 if (l < 0)
1629 err(EXIT_FAILURE, "read from routing socket");
1630 else
1631 return print_getmsg(&rtm, l, soup);
1632 }
1633 #endif /* SMALL */
1634 #undef rtm
1635 return 0;
1636 }
1637
1638 static void
1639 mask_addr(struct sou *soup)
1640 {
1641 int olen = soup->so_mask->sa.sa_len;
1642 char *cp1 = olen + (char *)&soup->so_mask, *cp2;
1643
1644 for (soup->so_mask->sa.sa_len = 0; cp1 > (char *)&soup->so_mask; )
1645 if (*--cp1 != 0) {
1646 soup->so_mask->sa.sa_len = 1 + cp1 - (char *)&soup->so_mask;
1647 break;
1648 }
1649 if ((rtm_addrs & RTA_DST) == 0)
1650 return;
1651 switch (soup->so_dst->sa.sa_family) {
1652 case AF_INET:
1653 #ifdef INET6
1654 case AF_INET6:
1655 #endif
1656 #ifndef SMALL
1657 case AF_APPLETALK:
1658 #endif /* SMALL */
1659 case 0:
1660 return;
1661 #ifndef SMALL
1662 case AF_ISO:
1663 olen = MIN(soup->so_dst->siso.siso_nlen,
1664 MAX(soup->so_mask->sa.sa_len - 6, 0));
1665 break;
1666 #endif /* SMALL */
1667 }
1668 cp1 = soup->so_mask->sa.sa_len + 1 + (char *)&soup->so_dst;
1669 cp2 = soup->so_dst->sa.sa_len + 1 + (char *)&soup->so_dst;
1670 while (cp2 > cp1)
1671 *--cp2 = 0;
1672 cp2 = soup->so_mask->sa.sa_len + 1 + (char *)&soup->so_mask;
1673 while (cp1 > soup->so_dst->sa.sa_data)
1674 *--cp1 &= *--cp2;
1675 #ifndef SMALL
1676 switch (soup->so_dst->sa.sa_family) {
1677 case AF_ISO:
1678 soup->so_dst->siso.siso_nlen = olen;
1679 break;
1680 }
1681 #endif /* SMALL */
1682 }
1683
1684 const char * const msgtypes[] = {
1685 [RTM_ADD] = "RTM_ADD: Add Route",
1686 [RTM_DELETE] = "RTM_DELETE: Delete Route",
1687 [RTM_CHANGE] = "RTM_CHANGE: Change Metrics or flags",
1688 [RTM_GET] = "RTM_GET: Report Metrics",
1689 [RTM_LOSING] = "RTM_LOSING: Kernel Suspects Partitioning",
1690 [RTM_REDIRECT] = "RTM_REDIRECT: Told to use different route",
1691 [RTM_MISS] = "RTM_MISS: Lookup failed on this address",
1692 [RTM_LOCK] = "RTM_LOCK: fix specified metrics",
1693 [RTM_OLDADD] = "RTM_OLDADD: caused by SIOCADDRT",
1694 [RTM_OLDDEL] = "RTM_OLDDEL: caused by SIOCDELRT",
1695 [RTM_RESOLVE] = "RTM_RESOLVE: Route created by cloning",
1696 [RTM_NEWADDR] = "RTM_NEWADDR: address being added to iface",
1697 [RTM_DELADDR] = "RTM_DELADDR: address being removed from iface",
1698 [RTM_OOIFINFO] = "RTM_OOIFINFO: iface status change (pre-1.5)",
1699 [RTM_OIFINFO] = "RTM_OIFINFO: iface status change (pre-64bit time)",
1700 [RTM_IFANNOUNCE] = "RTM_IFANNOUNCE: iface arrival/departure",
1701 [RTM_IEEE80211] = "RTM_IEEE80211: IEEE80211 wireless event",
1702 [RTM_IFINFO] = "RTM_IFINFO: iface status change",
1703 [RTM_CHGADDR] = "RTM_CHGADDR: address being changed on iface",
1704 };
1705
1706 const char metricnames[] =
1707 "\011pksent\010rttvar\7rtt\6ssthresh\5sendpipe\4recvpipe\3expire\2hopcount\1mtu";
1708 const char routeflags[] =
1709 "\1UP\2GATEWAY\3HOST\4REJECT\5DYNAMIC\6MODIFIED\7DONE\010MASK_PRESENT\011CLONING\012XRESOLVE\013LLINFO\014STATIC\015BLACKHOLE\016CLONED\017PROTO2\020PROTO1";
1710 const char ifnetflags[] =
1711 "\1UP\2BROADCAST\3DEBUG\4LOOPBACK\5PTP\6NOTRAILERS\7RUNNING\010NOARP\011PPROMISC\012ALLMULTI\013OACTIVE\014SIMPLEX\015LINK0\016LINK1\017LINK2\020MULTICAST";
1712 const char addrnames[] =
1713 "\1DST\2GATEWAY\3NETMASK\4GENMASK\5IFP\6IFA\7AUTHOR\010BRD\011TAG";
1714
1715
1716 #ifndef SMALL
1717 static const char *
1718 linkstate(struct if_msghdr *ifm)
1719 {
1720 static char buf[64];
1721
1722 switch (ifm->ifm_data.ifi_link_state) {
1723 case LINK_STATE_UNKNOWN:
1724 return "carrier: unknown";
1725 case LINK_STATE_DOWN:
1726 return "carrier: no carrier";
1727 case LINK_STATE_UP:
1728 return "carrier: active";
1729 default:
1730 (void)snprintf(buf, sizeof(buf), "carrier: 0x%x",
1731 ifm->ifm_data.ifi_link_state);
1732 return buf;
1733 }
1734 }
1735 #endif /* SMALL */
1736
1737 static void
1738 print_rtmsg(struct rt_msghdr *rtm, int msglen)
1739 {
1740 struct if_msghdr *ifm;
1741 struct ifa_msghdr *ifam;
1742 struct if_announcemsghdr *ifan;
1743 union {
1744 struct ieee80211_join_event join;
1745 struct ieee80211_leave_event leave;
1746 struct ieee80211_replay_event replay;
1747 struct ieee80211_michael_event michael;
1748 } ev;
1749 size_t evlen = 0;
1750
1751 if (verbose == 0)
1752 return;
1753 if (rtm->rtm_version != RTM_VERSION) {
1754 (void)printf("routing message version %d not understood\n",
1755 rtm->rtm_version);
1756 return;
1757 }
1758 if (msgtypes[rtm->rtm_type])
1759 (void)printf("%s: ", msgtypes[rtm->rtm_type]);
1760 else
1761 (void)printf("#%d: ", rtm->rtm_type);
1762 (void)printf("len %d, ", rtm->rtm_msglen);
1763 switch (rtm->rtm_type) {
1764 case RTM_IFINFO:
1765 ifm = (struct if_msghdr *)rtm;
1766 (void)printf("if# %d, %s, flags: ", ifm->ifm_index,
1767 #ifdef SMALL
1768 ""
1769 #else
1770 linkstate(ifm)
1771 #endif /* SMALL */
1772 );
1773 bprintf(stdout, ifm->ifm_flags, ifnetflags);
1774 pmsg_addrs((char *)(ifm + 1), ifm->ifm_addrs);
1775 break;
1776 case RTM_NEWADDR:
1777 case RTM_DELADDR:
1778 case RTM_CHGADDR:
1779 ifam = (struct ifa_msghdr *)rtm;
1780 (void)printf("metric %d, flags: ", ifam->ifam_metric);
1781 bprintf(stdout, ifam->ifam_flags, routeflags);
1782 pmsg_addrs((char *)(ifam + 1), ifam->ifam_addrs);
1783 break;
1784 case RTM_IEEE80211:
1785 ifan = (struct if_announcemsghdr *)rtm;
1786 (void)printf("if# %d, what: ", ifan->ifan_index);
1787 switch (ifan->ifan_what) {
1788 case RTM_IEEE80211_ASSOC:
1789 printf("associate");
1790 break;
1791 case RTM_IEEE80211_REASSOC:
1792 printf("re-associate");
1793 break;
1794 case RTM_IEEE80211_DISASSOC:
1795 printf("disassociate");
1796 break;
1797 case RTM_IEEE80211_SCAN:
1798 printf("scan complete");
1799 break;
1800 case RTM_IEEE80211_JOIN:
1801 evlen = sizeof(ev.join);
1802 printf("join");
1803 break;
1804 case RTM_IEEE80211_LEAVE:
1805 evlen = sizeof(ev.leave);
1806 printf("leave");
1807 break;
1808 case RTM_IEEE80211_MICHAEL:
1809 evlen = sizeof(ev.michael);
1810 printf("michael");
1811 break;
1812 case RTM_IEEE80211_REPLAY:
1813 evlen = sizeof(ev.replay);
1814 printf("replay");
1815 break;
1816 default:
1817 evlen = 0;
1818 printf("#%d", ifan->ifan_what);
1819 break;
1820 }
1821 if (sizeof(*ifan) + evlen > ifan->ifan_msglen) {
1822 printf(" (truncated)\n");
1823 break;
1824 }
1825 (void)memcpy(&ev, (ifan + 1), evlen);
1826 switch (ifan->ifan_what) {
1827 case RTM_IEEE80211_JOIN:
1828 case RTM_IEEE80211_LEAVE:
1829 printf(" mac %" PRIETHER,
1830 PRIETHER_ARGS(ev.join.iev_addr));
1831 break;
1832 case RTM_IEEE80211_REPLAY:
1833 case RTM_IEEE80211_MICHAEL:
1834 printf(" src %" PRIETHER " dst %" PRIETHER
1835 " cipher %" PRIu8 " keyix %" PRIu8,
1836 PRIETHER_ARGS(ev.replay.iev_src),
1837 PRIETHER_ARGS(ev.replay.iev_dst),
1838 ev.replay.iev_cipher,
1839 ev.replay.iev_keyix);
1840 if (ifan->ifan_what == RTM_IEEE80211_REPLAY) {
1841 printf(" key rsc %#" PRIx64
1842 " frame rsc %#" PRIx64,
1843 ev.replay.iev_keyrsc, ev.replay.iev_rsc);
1844 }
1845 break;
1846 default:
1847 break;
1848 }
1849 printf("\n");
1850 break;
1851 case RTM_IFANNOUNCE:
1852 ifan = (struct if_announcemsghdr *)rtm;
1853 (void)printf("if# %d, what: ", ifan->ifan_index);
1854 switch (ifan->ifan_what) {
1855 case IFAN_ARRIVAL:
1856 printf("arrival");
1857 break;
1858 case IFAN_DEPARTURE:
1859 printf("departure");
1860 break;
1861 default:
1862 printf("#%d", ifan->ifan_what);
1863 break;
1864 }
1865 printf("\n");
1866 break;
1867 default:
1868 (void)printf("pid %d, seq %d, errno %d, flags: ",
1869 rtm->rtm_pid, rtm->rtm_seq, rtm->rtm_errno);
1870 bprintf(stdout, rtm->rtm_flags, routeflags);
1871 pmsg_common(rtm);
1872 }
1873 }
1874
1875 #ifndef SMALL
1876 static int
1877 print_getmsg(struct rt_msghdr *rtm, int msglen, struct sou *soup)
1878 {
1879 struct sockaddr *dst = NULL, *gate = NULL, *mask = NULL, *ifa = NULL, *mpls = NULL;
1880 struct sockaddr_dl *ifp = NULL;
1881 struct sockaddr *sa;
1882 char *cp;
1883 int i;
1884
1885 if (! shortoutput) {
1886 (void)printf(" route to: %s\n",
1887 routename(&soup->so_dst->sa, NULL, RTF_HOST));
1888 }
1889 if (rtm->rtm_version != RTM_VERSION) {
1890 warnx("routing message version %d not understood",
1891 rtm->rtm_version);
1892 return 1;
1893 }
1894 if (rtm->rtm_msglen > msglen) {
1895 warnx("message length mismatch, in packet %d, returned %d",
1896 rtm->rtm_msglen, msglen);
1897 }
1898 if (rtm->rtm_errno) {
1899 warnx("RTM_GET: %s (errno %d)",
1900 strerror(rtm->rtm_errno), rtm->rtm_errno);
1901 return 1;
1902 }
1903 cp = ((char *)(rtm + 1));
1904 if (rtm->rtm_addrs)
1905 for (i = 1; i; i <<= 1)
1906 if (i & rtm->rtm_addrs) {
1907 sa = (struct sockaddr *)cp;
1908 switch (i) {
1909 case RTA_DST:
1910 dst = sa;
1911 break;
1912 case RTA_GATEWAY:
1913 gate = sa;
1914 break;
1915 case RTA_NETMASK:
1916 mask = sa;
1917 break;
1918 case RTA_IFP:
1919 if (sa->sa_family == AF_LINK &&
1920 ((struct sockaddr_dl *)sa)->sdl_nlen)
1921 ifp = (struct sockaddr_dl *)sa;
1922 break;
1923 case RTA_IFA:
1924 ifa = sa;
1925 break;
1926 case RTA_TAG:
1927 mpls = sa;
1928 break;
1929 }
1930 RT_ADVANCE(cp, sa);
1931 }
1932 if (dst && mask)
1933 mask->sa_family = dst->sa_family; /* XXX */
1934 if (dst && ! shortoutput)
1935 (void)printf("destination: %s\n",
1936 routename(dst, mask, RTF_HOST));
1937 if (mask && ! shortoutput) {
1938 int savenflag = nflag;
1939
1940 nflag = 1;
1941 (void)printf(" mask: %s\n",
1942 routename(mask, NULL, RTF_HOST));
1943 nflag = savenflag;
1944 }
1945 if (gate && rtm->rtm_flags & RTF_GATEWAY) {
1946 const char *name;
1947
1948 name = routename(gate, NULL, RTF_HOST);
1949 if (shortoutput) {
1950 if (*name == '\0')
1951 return 1;
1952 (void)printf("%s\n", name);
1953 } else
1954 (void)printf(" gateway: %s\n", name);
1955 }
1956 if (mpls) {
1957 const char *name;
1958 name = routename(mpls, NULL, RTF_HOST);
1959 if(shortoutput) {
1960 if (*name == '\0')
1961 return 1;
1962 printf("%s\n", name);
1963 } else
1964 printf(" Tag: %s\n", name);
1965 }
1966
1967 if (ifa && ! shortoutput)
1968 (void)printf(" local addr: %s\n",
1969 routename(ifa, NULL, RTF_HOST));
1970 if (ifp && ! shortoutput)
1971 (void)printf(" interface: %.*s\n",
1972 ifp->sdl_nlen, ifp->sdl_data);
1973 if (! shortoutput) {
1974 (void)printf(" flags: ");
1975 bprintf(stdout, rtm->rtm_flags, routeflags);
1976 }
1977
1978 #define lock(f) ((rtm->rtm_rmx.rmx_locks & __CONCAT(RTV_,f)) ? 'L' : ' ')
1979 #define msec(u) (((u) + 500) / 1000) /* usec to msec */
1980
1981 if (! shortoutput) {
1982 (void)printf("\n%s\n", "\
1983 recvpipe sendpipe ssthresh rtt,msec rttvar hopcount mtu expire");
1984 printf("%8"PRId64"%c ", rtm->rtm_rmx.rmx_recvpipe, lock(RPIPE));
1985 printf("%8"PRId64"%c ", rtm->rtm_rmx.rmx_sendpipe, lock(SPIPE));
1986 printf("%8"PRId64"%c ", rtm->rtm_rmx.rmx_ssthresh, lock(SSTHRESH));
1987 printf("%8"PRId64"%c ", msec(rtm->rtm_rmx.rmx_rtt), lock(RTT));
1988 printf("%8"PRId64"%c ", msec(rtm->rtm_rmx.rmx_rttvar), lock(RTTVAR));
1989 printf("%8"PRId64"%c ", rtm->rtm_rmx.rmx_hopcount, lock(HOPCOUNT));
1990 printf("%8"PRId64"%c ", rtm->rtm_rmx.rmx_mtu, lock(MTU));
1991 if (rtm->rtm_rmx.rmx_expire)
1992 rtm->rtm_rmx.rmx_expire -= time(0);
1993 printf("%8"PRId64"%c\n", rtm->rtm_rmx.rmx_expire, lock(EXPIRE));
1994 }
1995 #undef lock
1996 #undef msec
1997 #define RTA_IGN (RTA_DST|RTA_GATEWAY|RTA_NETMASK|RTA_IFP|RTA_IFA|RTA_BRD)
1998
1999 if (shortoutput)
2000 return (rtm->rtm_addrs & RTF_GATEWAY) == 0;
2001 else if (verbose)
2002 pmsg_common(rtm);
2003 else if (rtm->rtm_addrs &~ RTA_IGN) {
2004 (void)printf("sockaddrs: ");
2005 bprintf(stdout, rtm->rtm_addrs, addrnames);
2006 putchar('\n');
2007 }
2008 return 0;
2009 #undef RTA_IGN
2010 }
2011 #endif /* SMALL */
2012
2013 void
2014 pmsg_common(struct rt_msghdr *rtm)
2015 {
2016 (void)printf("\nlocks: ");
2017 bprintf(stdout, rtm->rtm_rmx.rmx_locks, metricnames);
2018 (void)printf(" inits: ");
2019 bprintf(stdout, rtm->rtm_inits, metricnames);
2020 pmsg_addrs((char *)(rtm + 1), rtm->rtm_addrs);
2021 }
2022
2023 static void
2024 extract_addrs(const char *cp, int addrs, const struct sockaddr *sa[], int *nmfp)
2025 {
2026 int i, nmf = -1;
2027
2028 for (i = 0; i < RTAX_MAX; i++) {
2029 if ((1 << i) & addrs) {
2030 sa[i] = (const struct sockaddr *)cp;
2031 if ((i == RTAX_DST || i == RTAX_IFA) &&
2032 nmf == -1)
2033 nmf = sa[i]->sa_family;
2034 RT_ADVANCE(cp, sa[i]);
2035 } else
2036 sa[i] = NULL;
2037 }
2038
2039 if (nmfp != NULL)
2040 *nmfp = nmf;
2041 }
2042
2043 static void
2044 pmsg_addrs(const char *cp, int addrs)
2045 {
2046 const struct sockaddr *sa[RTAX_MAX];
2047 int i, nmf;
2048
2049 if (addrs != 0) {
2050 (void)printf("\nsockaddrs: ");
2051 bprintf(stdout, addrs, addrnames);
2052 (void)putchar('\n');
2053 extract_addrs(cp, addrs, sa, &nmf);
2054 for (i = 0; i < RTAX_MAX; i++) {
2055 if (sa[i] == NULL)
2056 continue;
2057
2058 if (i == RTAX_NETMASK && sa[i]->sa_len)
2059 (void)printf(" %s",
2060 netmask_string(sa[i], -1, nmf));
2061 else
2062 (void)printf(" %s",
2063 routename(sa[i], NULL, RTF_HOST));
2064 }
2065 }
2066 (void)putchar('\n');
2067 (void)fflush(stdout);
2068 }
2069
2070 static void
2071 bprintf(FILE *fp, int b, const char *f)
2072 {
2073 int i;
2074 int gotsome = 0;
2075 const uint8_t *s = (const uint8_t *)f;
2076
2077 if (b == 0) {
2078 fputs("none", fp);
2079 return;
2080 }
2081 while ((i = *s++) != 0) {
2082 if (b & (1 << (i-1))) {
2083 if (gotsome == 0)
2084 i = '<';
2085 else
2086 i = ',';
2087 (void)putc(i, fp);
2088 gotsome = 1;
2089 for (; (i = *s) > 32; s++)
2090 (void)putc(i, fp);
2091 } else
2092 while (*s > 32)
2093 s++;
2094 }
2095 if (gotsome)
2096 (void)putc('>', fp);
2097 }
2098
2099 int
2100 keyword(const char *cp)
2101 {
2102 struct keytab *kt = keywords;
2103
2104 while (kt->kt_cp && strcmp(kt->kt_cp, cp))
2105 kt++;
2106 return kt->kt_i;
2107 }
2108
2109 static void
2110 sodump(sup su, const char *which)
2111 {
2112 #ifdef INET6
2113 char ntop_buf[NI_MAXHOST];
2114 #endif
2115
2116 switch (su->sa.sa_family) {
2117 case AF_INET:
2118 (void)printf("%s: inet %s; ",
2119 which, inet_ntoa(su->sin.sin_addr));
2120 break;
2121 #ifndef SMALL
2122 case AF_APPLETALK:
2123 (void)printf("%s: atalk %d.%d; ",
2124 which, su->sat.sat_addr.s_net, su->sat.sat_addr.s_node);
2125 break;
2126 #endif
2127 case AF_LINK:
2128 (void)printf("%s: link %s; ",
2129 which, link_ntoa(&su->sdl));
2130 break;
2131 #ifdef INET6
2132 case AF_INET6:
2133 (void)printf("%s: inet6 %s; ",
2134 which, inet_ntop(AF_INET6, &su->sin6.sin6_addr,
2135 ntop_buf, sizeof(ntop_buf)));
2136 break;
2137 #endif
2138 #ifndef SMALL
2139 case AF_ISO:
2140 (void)printf("%s: iso %s; ",
2141 which, iso_ntoa(&su->siso.siso_addr));
2142 break;
2143 case AF_MPLS:
2144 {
2145 union mpls_shim ms;
2146 const union mpls_shim *pms;
2147 int psize = sizeof(struct sockaddr_mpls);
2148
2149 ms.s_addr = ntohl(su->smpls.smpls_addr.s_addr);
2150 printf("%s: mpls %u; ",
2151 which, ms.shim.label);
2152
2153 pms = &su->smpls.smpls_addr;
2154 while(psize < su->smpls.smpls_len) {
2155 pms++;
2156 ms.s_addr = ntohl(pms->s_addr);
2157 printf("%u; ", ms.shim.label);
2158 psize += sizeof(ms);
2159 }
2160 break;
2161 }
2162 #endif /* SMALL */
2163 default:
2164 (void)printf("%s: (%d) %s; ",
2165 which, su->sa.sa_family, any_ntoa(&su->sa));
2166 }
2167 (void)fflush(stdout);
2168 }
2169
2170 /* States*/
2171 #define VIRGIN 0
2172 #define GOTONE 1
2173 #define GOTTWO 2
2174 /* Inputs */
2175 #define DIGIT (4*0)
2176 #define END (4*1)
2177 #define DELIM (4*2)
2178
2179 static void
2180 sockaddr(const char *addr, struct sockaddr *sa)
2181 {
2182 char *cp = (char *)sa;
2183 int size = sa->sa_len;
2184 char *cplim = cp + size;
2185 int byte = 0, state = VIRGIN, new = 0;
2186
2187 (void)memset(cp, 0, size);
2188 cp++;
2189 do {
2190 if ((*addr >= '0') && (*addr <= '9')) {
2191 new = *addr - '0';
2192 } else if ((*addr >= 'a') && (*addr <= 'f')) {
2193 new = *addr - 'a' + 10;
2194 } else if ((*addr >= 'A') && (*addr <= 'F')) {
2195 new = *addr - 'A' + 10;
2196 } else if (*addr == 0)
2197 state |= END;
2198 else
2199 state |= DELIM;
2200 addr++;
2201 switch (state /* | INPUT */) {
2202 case GOTTWO | DIGIT:
2203 *cp++ = byte; /*FALLTHROUGH*/
2204 case VIRGIN | DIGIT:
2205 state = GOTONE; byte = new; continue;
2206 case GOTONE | DIGIT:
2207 state = GOTTWO; byte = new + (byte << 4); continue;
2208 default: /* | DELIM */
2209 state = VIRGIN; *cp++ = byte; byte = 0; continue;
2210 case GOTONE | END:
2211 case GOTTWO | END:
2212 *cp++ = byte; /* FALLTHROUGH */
2213 case VIRGIN | END:
2214 break;
2215 }
2216 break;
2217 } while (cp < cplim);
2218 sa->sa_len = cp - (char *)sa;
2219 }
2220