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