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