Kernel part of bluetooth stack ported by Dmitry Komissaroff. Very much work
[dragonfly.git] / usr.sbin / route6d / route6d.c
blob9a1a9100fc4466e9fc7f3f0ad499b723d510ef4c
1 /* $FreeBSD: src/usr.sbin/route6d/route6d.c,v 1.2.2.5 2001/07/03 11:02:09 ume Exp $ */
2 /* $DragonFly: src/usr.sbin/route6d/route6d.c,v 1.8 2005/12/05 02:40:28 swildner Exp $ */
3 /* $KAME: route6d.c,v 1.64 2001/05/08 04:36:37 itojun Exp $ */
5 /*
6 * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project.
7 * All rights reserved.
8 *
9 * Redistribution and use in source and binary forms, with or without
10 * modification, are permitted provided that the following conditions
11 * are met:
12 * 1. Redistributions of source code must retain the above copyright
13 * notice, this list of conditions and the following disclaimer.
14 * 2. Redistributions in binary form must reproduce the above copyright
15 * notice, this list of conditions and the following disclaimer in the
16 * documentation and/or other materials provided with the distribution.
17 * 3. Neither the name of the project nor the names of its contributors
18 * may be used to endorse or promote products derived from this software
19 * without specific prior written permission.
21 * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
22 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
23 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
24 * ARE DISCLAIMED. IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
25 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
26 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
27 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
28 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
29 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
30 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
31 * SUCH DAMAGE.
33 * $KAME: route6d.c,v 1.64 2001/05/08 04:36:37 itojun Exp $
36 #define _KERNEL_STRUCTURES
38 #include <stdio.h>
40 #include <time.h>
41 #include <unistd.h>
42 #include <stdlib.h>
43 #include <string.h>
44 #include <signal.h>
45 #ifdef __STDC__
46 #include <stdarg.h>
47 #else
48 #include <varargs.h>
49 #endif
50 #include <syslog.h>
51 #include <stddef.h>
52 #include <errno.h>
53 #include <err.h>
55 #include <sys/types.h>
56 #include <sys/param.h>
57 #include <sys/file.h>
58 #include <sys/socket.h>
59 #include <sys/ioctl.h>
60 #include <sys/sysctl.h>
61 #include <sys/uio.h>
62 #include <net/if.h>
63 #if defined(__DragonFly__)
64 #include <net/if_var.h>
65 #endif /* __DragonFly__ */
66 #include <net/route.h>
67 #include <netinet/in.h>
68 #include <netinet/in_var.h>
69 #include <netinet/ip6.h>
70 #include <netinet/udp.h>
71 #include <netdb.h>
72 #include <ifaddrs.h>
74 #include <arpa/inet.h>
76 #include "route6d.h"
78 #define MAXFILTER 40
80 #ifdef DEBUG
81 #define INIT_INTERVAL6 6
82 #else
83 #define INIT_INTERVAL6 10 /* Wait to submit a initial riprequest */
84 #endif
86 /* alignment constraint for routing socket */
87 #define ROUNDUP(a) \
88 ((a) > 0 ? (1 + (((a) - 1) | (sizeof(long) - 1))) : sizeof(long))
89 #define ADVANCE(x, n) (x += ROUNDUP((n)->sa_len))
92 * Following two macros are highly depending on KAME Release
94 #define IN6_LINKLOCAL_IFINDEX(addr) \
95 ((addr).s6_addr[2] << 8 | (addr).s6_addr[3])
97 #define SET_IN6_LINKLOCAL_IFINDEX(addr, index) \
98 do { \
99 (addr).s6_addr[2] = ((index) >> 8) & 0xff; \
100 (addr).s6_addr[3] = (index) & 0xff; \
101 } while (0)
103 struct ifc { /* Configuration of an interface */
104 char *ifc_name; /* if name */
105 struct ifc *ifc_next;
106 int ifc_index; /* if index */
107 int ifc_mtu; /* if mtu */
108 int ifc_metric; /* if metric */
109 u_int ifc_flags; /* flags */
110 short ifc_cflags; /* IFC_XXX */
111 struct in6_addr ifc_mylladdr; /* my link-local address */
112 struct sockaddr_in6 ifc_ripsin; /* rip multicast address */
113 struct iff *ifc_filter; /* filter structure */
114 struct ifac *ifc_addr; /* list of AF_INET6 addresses */
115 int ifc_joined; /* joined to ff02::9 */
118 struct ifac { /* Adddress associated to an interface */
119 struct ifc *ifa_conf; /* back pointer */
120 struct ifac *ifa_next;
121 struct in6_addr ifa_addr; /* address */
122 struct in6_addr ifa_raddr; /* remote address, valid in p2p */
123 int ifa_plen; /* prefix length */
126 struct iff {
127 int iff_type;
128 struct in6_addr iff_addr;
129 int iff_plen;
130 struct iff *iff_next;
133 struct ifc *ifc;
134 int nifc; /* number of valid ifc's */
135 struct ifc **index2ifc;
136 int nindex2ifc;
137 struct ifc *loopifcp = NULL; /* pointing to loopback */
138 int loopifindex = 0; /* ditto */
139 fd_set sockvec; /* vector to select() for receiving */
140 int rtsock; /* the routing socket */
141 int ripsock; /* socket to send/receive RIP datagram */
143 struct rip6 *ripbuf; /* packet buffer for sending */
146 * Maintain the routes in a linked list. When the number of the routes
147 * grows, somebody would like to introduce a hash based or a radix tree
148 * based structure. I believe the number of routes handled by RIP is
149 * limited and I don't have to manage a complex data structure, however.
151 * One of the major drawbacks of the linear linked list is the difficulty
152 * of representing the relationship between a couple of routes. This may
153 * be a significant problem when we have to support route aggregation with
154 * supressing the specifices covered by the aggregate.
157 struct riprt {
158 struct riprt *rrt_next; /* next destination */
159 struct riprt *rrt_same; /* same destination - future use */
160 struct netinfo6 rrt_info; /* network info */
161 struct in6_addr rrt_gw; /* gateway */
162 u_long rrt_flags; /* kernel routing table flags */
163 u_long rrt_rflags; /* route6d routing table flags */
164 time_t rrt_t; /* when the route validated */
165 int rrt_index; /* ifindex from which this route got */
168 struct riprt *riprt = 0;
170 int dflag = 0; /* debug flag */
171 int qflag = 0; /* quiet flag */
172 int nflag = 0; /* don't update kernel routing table */
173 int aflag = 0; /* age out even the statically defined routes */
174 int hflag = 0; /* don't split horizon */
175 int lflag = 0; /* exchange site local routes */
176 int sflag = 0; /* announce static routes w/ split horizon */
177 int Sflag = 0; /* announce static routes to every interface */
178 unsigned long routetag = 0; /* route tag attached on originating case */
180 char *filter[MAXFILTER];
181 int filtertype[MAXFILTER];
182 int nfilter = 0;
184 pid_t pid;
186 struct sockaddr_storage ripsin;
188 struct rtentry rtentry;
190 int interval = 1;
191 time_t nextalarm = 0;
192 time_t sup_trig_update = 0;
194 FILE *rtlog = NULL;
196 int logopened = 0;
198 static u_long seq = 0;
200 volatile int signo;
201 volatile sig_atomic_t seenalrm;
202 volatile sig_atomic_t seenquit;
203 volatile sig_atomic_t seenusr1;
205 #define RRTF_AGGREGATE 0x08000000
206 #define RRTF_NOADVERTISE 0x10000000
207 #define RRTF_NH_NOT_LLADDR 0x20000000
208 #define RRTF_SENDANYWAY 0x40000000
209 #define RRTF_CHANGED 0x80000000
211 int main(int, char **);
212 void sighandler(int);
213 void ripalarm(void);
214 void riprecv(void);
215 void ripsend(struct ifc *, struct sockaddr_in6 *, int);
216 int out_filter(struct riprt *, struct ifc *);
217 void init(void);
218 void sockopt(struct ifc *);
219 void ifconfig(void);
220 void ifconfig1(const char *, const struct sockaddr *, struct ifc *, int);
221 void rtrecv(void);
222 int rt_del(const struct sockaddr_in6 *, const struct sockaddr_in6 *,
223 const struct sockaddr_in6 *);
224 int rt_deladdr(struct ifc *, const struct sockaddr_in6 *,
225 const struct sockaddr_in6 *);
226 void filterconfig(void);
227 int getifmtu(int);
228 const char *rttypes(struct rt_msghdr *);
229 const char *rtflags(struct rt_msghdr *);
230 const char *ifflags(int);
231 int ifrt(struct ifc *, int);
232 void ifrt_p2p(struct ifc *, int);
233 void applymask(struct in6_addr *, struct in6_addr *);
234 void applyplen(struct in6_addr *, int);
235 void ifrtdump(int);
236 void ifdump(int);
237 void ifdump0(FILE *, const struct ifc *);
238 void rtdump(int);
239 void rt_entry(struct rt_msghdr *, int);
240 void rtdexit(void);
241 void riprequest(struct ifc *, struct netinfo6 *, int,
242 struct sockaddr_in6 *);
243 void ripflush(struct ifc *, struct sockaddr_in6 *);
244 void sendrequest(struct ifc *);
245 int sin6mask2len(const struct sockaddr_in6 *);
246 int mask2len(const struct in6_addr *, int);
247 int sendpacket(struct sockaddr_in6 *, int);
248 int addroute(struct riprt *, const struct in6_addr *, struct ifc *);
249 int delroute(struct netinfo6 *, struct in6_addr *);
250 struct in6_addr *getroute(struct netinfo6 *, struct in6_addr *);
251 void krtread(int);
252 int tobeadv(struct riprt *, struct ifc *);
253 char *allocopy(char *);
254 char *hms(void);
255 const char *inet6_n2p(const struct in6_addr *);
256 struct ifac *ifa_match(const struct ifc *, const struct in6_addr *, int);
257 struct in6_addr *plen2mask(int);
258 struct riprt *rtsearch(struct netinfo6 *, struct riprt **);
259 int ripinterval(int);
260 time_t ripsuptrig(void);
261 void fatal(const char *, ...)
262 __attribute__((__format__(__printf__, 1, 2)));
263 void trace(int, const char *, ...)
264 __attribute__((__format__(__printf__, 2, 3)));
265 void tracet(int, const char *, ...)
266 __attribute__((__format__(__printf__, 2, 3)));
267 unsigned int if_maxindex(void);
268 struct ifc *ifc_find(char *);
269 struct iff *iff_find(struct ifc *, int);
270 void setindex2ifc(int, struct ifc *);
272 #define MALLOC(type) ((type *)malloc(sizeof(type)))
275 main(int argc, char **argv)
277 int ch;
278 int error = 0;
279 struct ifc *ifcp;
280 sigset_t mask, omask;
281 FILE *pidfile;
282 char *progname;
283 char *ep;
285 progname = strrchr(*argv, '/');
286 if (progname)
287 progname++;
288 else
289 progname = *argv;
291 pid = getpid();
292 while ((ch = getopt(argc, argv, "A:N:O:R:T:L:t:adDhlnqsS")) != -1) {
293 switch (ch) {
294 case 'A':
295 case 'N':
296 case 'O':
297 case 'T':
298 case 'L':
299 if (nfilter >= MAXFILTER) {
300 fatal("Exceeds MAXFILTER");
301 /*NOTREACHED*/
303 filtertype[nfilter] = ch;
304 filter[nfilter++] = allocopy(optarg);
305 break;
306 case 't':
307 ep = NULL;
308 routetag = strtoul(optarg, &ep, 0);
309 if (!ep || *ep != '\0' || (routetag & ~0xffff) != 0) {
310 fatal("invalid route tag");
311 /*NOTREACHED*/
313 break;
314 case 'R':
315 if ((rtlog = fopen(optarg, "w")) == NULL) {
316 fatal("Can not write to routelog");
317 /*NOTREACHED*/
319 break;
320 #define FLAG(c, flag, n) case c: do { flag = n; break; } while(0)
321 FLAG('a', aflag, 1); break;
322 FLAG('d', dflag, 1); break;
323 FLAG('D', dflag, 2); break;
324 FLAG('h', hflag, 1); break;
325 FLAG('l', lflag, 1); break;
326 FLAG('n', nflag, 1); break;
327 FLAG('q', qflag, 1); break;
328 FLAG('s', sflag, 1); break;
329 FLAG('S', Sflag, 1); break;
330 #undef FLAG
331 default:
332 fatal("Invalid option specified, terminating");
333 /*NOTREACHED*/
336 argc -= optind;
337 argv += optind;
338 if (argc > 0) {
339 fatal("bogus extra arguments");
340 /*NOTREACHED*/
343 if (geteuid()) {
344 nflag = 1;
345 fprintf(stderr, "No kernel update is allowed\n");
347 openlog(progname, LOG_NDELAY|LOG_PID, LOG_DAEMON);
348 logopened++;
350 if ((ripbuf = (struct rip6 *)malloc(RIP6_MAXMTU)) == NULL)
351 fatal("malloc");
352 memset(ripbuf, 0, RIP6_MAXMTU);
353 ripbuf->rip6_cmd = RIP6_RESPONSE;
354 ripbuf->rip6_vers = RIP6_VERSION;
355 ripbuf->rip6_res1[0] = 0;
356 ripbuf->rip6_res1[1] = 0;
358 init();
359 ifconfig();
360 for (ifcp = ifc; ifcp; ifcp = ifcp->ifc_next) {
361 if (ifcp->ifc_index < 0) {
362 fprintf(stderr,
363 "No ifindex found at %s (no link-local address?)\n",
364 ifcp->ifc_name);
365 error++;
368 if (error)
369 exit(1);
370 if (loopifcp == NULL) {
371 fatal("No loopback found");
372 /*NOTREACHED*/
374 loopifindex = loopifcp->ifc_index;
375 for (ifcp = ifc; ifcp; ifcp = ifcp->ifc_next)
376 ifrt(ifcp, 0);
377 filterconfig();
378 krtread(0);
379 if (dflag)
380 ifrtdump(0);
382 if (dflag == 0) {
383 #if 1
384 if (daemon(0, 0) < 0) {
385 fatal("daemon");
386 /*NOTREACHED*/
388 #else
389 if (fork())
390 exit(0);
391 if (setsid() < 0) {
392 fatal("setid");
393 /*NOTREACHED*/
395 #endif
397 pid = getpid();
398 if ((pidfile = fopen(ROUTE6D_PID, "w")) != NULL) {
399 fprintf(pidfile, "%d\n", pid);
400 fclose(pidfile);
403 if ((ripbuf = (struct rip6 *)malloc(RIP6_MAXMTU)) == NULL) {
404 fatal("malloc");
405 /*NOTREACHED*/
407 memset(ripbuf, 0, RIP6_MAXMTU);
408 ripbuf->rip6_cmd = RIP6_RESPONSE;
409 ripbuf->rip6_vers = RIP6_VERSION;
410 ripbuf->rip6_res1[0] = 0;
411 ripbuf->rip6_res1[1] = 0;
413 if (signal(SIGALRM, sighandler) == SIG_ERR ||
414 signal(SIGQUIT, sighandler) == SIG_ERR ||
415 signal(SIGTERM, sighandler) == SIG_ERR ||
416 signal(SIGUSR1, sighandler) == SIG_ERR ||
417 signal(SIGHUP, sighandler) == SIG_ERR ||
418 signal(SIGINT, sighandler) == SIG_ERR) {
419 fatal("signal");
420 /*NOTREACHED*/
423 * To avoid rip packet congestion (not on a cable but in this
424 * process), wait for a moment to send the first RIP6_RESPONSE
425 * packets.
427 alarm(ripinterval(INIT_INTERVAL6));
429 for (ifcp = ifc; ifcp; ifcp = ifcp->ifc_next) {
430 if (ifcp->ifc_index > 0 && (ifcp->ifc_flags & IFF_UP))
431 sendrequest(ifcp);
434 syslog(LOG_INFO, "**** Started ****");
435 sigemptyset(&mask);
436 sigaddset(&mask, SIGALRM);
437 while (1) {
438 fd_set recvec;
440 if (seenalrm) {
441 ripalarm();
442 seenalrm = 0;
443 continue;
445 if (seenquit) {
446 rtdexit();
447 seenquit = 0;
448 continue;
450 if (seenusr1) {
451 ifrtdump(SIGUSR1);
452 seenusr1 = 0;
453 continue;
456 FD_COPY(&sockvec, &recvec);
457 signo = 0;
458 switch (select(FD_SETSIZE, &recvec, 0, 0, 0)) {
459 case -1:
460 if (errno != EINTR) {
461 fatal("select");
462 /*NOTREACHED*/
464 continue;
465 case 0:
466 continue;
467 default:
468 if (FD_ISSET(ripsock, &recvec)) {
469 sigprocmask(SIG_BLOCK, &mask, &omask);
470 riprecv();
471 sigprocmask(SIG_SETMASK, &omask, NULL);
473 if (FD_ISSET(rtsock, &recvec)) {
474 sigprocmask(SIG_BLOCK, &mask, &omask);
475 rtrecv();
476 sigprocmask(SIG_SETMASK, &omask, NULL);
482 void
483 sighandler(int sig)
486 signo = sig;
487 switch (signo) {
488 case SIGALRM:
489 seenalrm++;
490 break;
491 case SIGQUIT:
492 case SIGTERM:
493 seenquit++;
494 break;
495 case SIGUSR1:
496 case SIGHUP:
497 case SIGINT:
498 seenusr1++;
499 break;
504 * gracefully exits after resetting sockopts.
506 /* ARGSUSED */
507 void
508 rtdexit(void)
510 struct riprt *rrt;
512 alarm(0);
513 for (rrt = riprt; rrt; rrt = rrt->rrt_next) {
514 if (rrt->rrt_rflags & RRTF_AGGREGATE) {
515 delroute(&rrt->rrt_info, &rrt->rrt_gw);
518 close(ripsock);
519 close(rtsock);
520 syslog(LOG_INFO, "**** Terminated ****");
521 closelog();
522 exit(1);
526 * Called periodically:
527 * 1. age out the learned route. remove it if necessary.
528 * 2. submit RIP6_RESPONSE packets.
529 * Invoked in every SUPPLY_INTERVAL6 (30) seconds. I believe we don't have
530 * to invoke this function in every 1 or 5 or 10 seconds only to age the
531 * routes more precisely.
533 /* ARGSUSED */
534 void
535 ripalarm(void)
537 struct ifc *ifcp;
538 struct riprt *rrt, *rrt_prev, *rrt_next;
539 time_t t_lifetime, t_holddown;
541 /* age the RIP routes */
542 rrt_prev = 0;
543 t_lifetime = time(NULL) - RIP_LIFETIME;
544 t_holddown = t_lifetime - RIP_HOLDDOWN;
545 for (rrt = riprt; rrt; rrt = rrt_next) {
546 rrt_next = rrt->rrt_next;
548 if (rrt->rrt_t == 0) {
549 rrt_prev = rrt;
550 continue;
552 if (rrt->rrt_t < t_holddown) {
553 if (rrt_prev) {
554 rrt_prev->rrt_next = rrt->rrt_next;
555 } else {
556 riprt = rrt->rrt_next;
558 delroute(&rrt->rrt_info, &rrt->rrt_gw);
559 free(rrt);
560 continue;
562 if (rrt->rrt_t < t_lifetime)
563 rrt->rrt_info.rip6_metric = HOPCNT_INFINITY6;
564 rrt_prev = rrt;
566 /* Supply updates */
567 for (ifcp = ifc; ifcp; ifcp = ifcp->ifc_next) {
568 if (ifcp->ifc_index > 0 && (ifcp->ifc_flags & IFF_UP))
569 ripsend(ifcp, &ifcp->ifc_ripsin, 0);
571 alarm(ripinterval(SUPPLY_INTERVAL6));
574 void
575 init(void)
577 int i, int0, int255, error;
578 struct addrinfo hints, *res;
579 char port[10];
581 ifc = (struct ifc *)NULL;
582 nifc = 0;
583 nindex2ifc = 0; /*initial guess*/
584 index2ifc = NULL;
585 snprintf(port, sizeof(port), "%d", RIP6_PORT);
587 memset(&hints, 0, sizeof(hints));
588 hints.ai_family = PF_INET6;
589 hints.ai_socktype = SOCK_DGRAM;
590 hints.ai_flags = AI_PASSIVE;
591 error = getaddrinfo(NULL, port, &hints, &res);
592 if (error) {
593 fatal("%s", gai_strerror(error));
594 /*NOTREACHED*/
596 if (res->ai_next) {
597 fatal(":: resolved to multiple address");
598 /*NOTREACHED*/
601 int0 = 0; int255 = 255;
602 ripsock = socket(res->ai_family, res->ai_socktype, res->ai_protocol);
603 if (ripsock < 0) {
604 fatal("rip socket");
605 /*NOTREACHED*/
607 if (bind(ripsock, res->ai_addr, res->ai_addrlen) < 0) {
608 fatal("rip bind");
609 /*NOTREACHED*/
611 if (setsockopt(ripsock, IPPROTO_IPV6, IPV6_MULTICAST_HOPS,
612 &int255, sizeof(int255)) < 0) {
613 fatal("rip IPV6_MULTICAST_HOPS");
614 /*NOTREACHED*/
616 if (setsockopt(ripsock, IPPROTO_IPV6, IPV6_MULTICAST_LOOP,
617 &int0, sizeof(int0)) < 0) {
618 fatal("rip IPV6_MULTICAST_LOOP");
619 /*NOTREACHED*/
622 i = 1;
623 #ifdef IPV6_RECVPKTINFO
624 if (setsockopt(ripsock, IPPROTO_IPV6, IPV6_RECVPKTINFO, &i,
625 sizeof(i)) < 0) {
626 fatal("rip IPV6_RECVPKTINFO");
627 /*NOTREACHED*/
629 #else /* old adv. API */
630 if (setsockopt(ripsock, IPPROTO_IPV6, IPV6_PKTINFO, &i,
631 sizeof(i)) < 0) {
632 fatal("rip IPV6_PKTINFO");
633 /*NOTREACHED*/
635 #endif
637 memset(&hints, 0, sizeof(hints));
638 hints.ai_family = PF_INET6;
639 hints.ai_socktype = SOCK_DGRAM;
640 error = getaddrinfo(RIP6_DEST, port, &hints, &res);
641 if (error) {
642 fatal("%s", gai_strerror(error));
643 /*NOTREACHED*/
645 if (res->ai_next) {
646 fatal("%s resolved to multiple address", RIP6_DEST);
647 /*NOTREACHED*/
649 memcpy(&ripsin, res->ai_addr, res->ai_addrlen);
651 #ifdef FD_ZERO
652 FD_ZERO(&sockvec);
653 #else
654 memset(&sockvec, 0, sizeof(sockvec));
655 #endif
656 FD_SET(ripsock, &sockvec);
658 if (nflag == 0) {
659 if ((rtsock = socket(PF_ROUTE, SOCK_RAW, 0)) < 0) {
660 fatal("route socket");
661 /*NOTREACHED*/
663 FD_SET(rtsock, &sockvec);
664 } else
665 rtsock = -1; /*just for safety */
668 #define RIPSIZE(n) \
669 (sizeof(struct rip6) + ((n)-1) * sizeof(struct netinfo6))
672 * ripflush flushes the rip datagram stored in the rip buffer
674 static int nrt;
675 static struct netinfo6 *np;
677 void
678 ripflush(struct ifc *ifcp, struct sockaddr_in6 *sin)
680 int i;
681 int error;
683 if (ifcp)
684 tracet(1, "Send(%s): info(%d) to %s.%d\n",
685 ifcp->ifc_name, nrt,
686 inet6_n2p(&sin->sin6_addr), ntohs(sin->sin6_port));
687 else
688 tracet(1, "Send: info(%d) to %s.%d\n",
689 nrt, inet6_n2p(&sin->sin6_addr), ntohs(sin->sin6_port));
690 if (dflag >= 2) {
691 np = ripbuf->rip6_nets;
692 for (i = 0; i < nrt; i++, np++) {
693 if (np->rip6_metric == NEXTHOP_METRIC) {
694 if (IN6_IS_ADDR_UNSPECIFIED(&np->rip6_dest))
695 trace(2, " NextHop reset");
696 else {
697 trace(2, " NextHop %s",
698 inet6_n2p(&np->rip6_dest));
700 } else {
701 trace(2, " %s/%d[%d]",
702 inet6_n2p(&np->rip6_dest),
703 np->rip6_plen, np->rip6_metric);
705 if (np->rip6_tag) {
706 trace(2, " tag=0x%04x",
707 ntohs(np->rip6_tag) & 0xffff);
709 trace(2, "\n");
712 error = sendpacket(sin, RIPSIZE(nrt));
713 if (error == EAFNOSUPPORT) {
714 /* Protocol not supported */
715 tracet(1, "Could not send info to %s (%s): "
716 "set IFF_UP to 0\n",
717 ifcp->ifc_name, inet6_n2p(&ifcp->ifc_ripsin.sin6_addr));
718 ifcp->ifc_flags &= ~IFF_UP; /* As if down for AF_INET6 */
720 nrt = 0; np = ripbuf->rip6_nets;
724 * Generate RIP6_RESPONSE packets and send them.
726 void
727 ripsend(struct ifc *ifcp, struct sockaddr_in6 *sin, int flag)
729 struct riprt *rrt;
730 struct in6_addr *nh; /* next hop */
731 int maxrte;
733 if (ifcp == NULL) {
735 * Request from non-link local address is not
736 * a regular route6d update.
738 maxrte = (IFMINMTU - sizeof(struct ip6_hdr) -
739 sizeof(struct udphdr) -
740 sizeof(struct rip6) + sizeof(struct netinfo6)) /
741 sizeof(struct netinfo6);
742 nrt = 0; np = ripbuf->rip6_nets; nh = NULL;
743 for (rrt = riprt; rrt; rrt = rrt->rrt_next) {
744 if (rrt->rrt_rflags & RRTF_NOADVERTISE)
745 continue;
746 /* Put the route to the buffer */
747 *np = rrt->rrt_info;
748 np++; nrt++;
749 if (nrt == maxrte) {
750 ripflush(NULL, sin);
751 nh = NULL;
754 if (nrt) /* Send last packet */
755 ripflush(NULL, sin);
756 return;
759 if ((flag & RRTF_SENDANYWAY) == 0 &&
760 (qflag || (ifcp->ifc_flags & IFF_LOOPBACK)))
761 return;
763 /* -N: no use */
764 if (iff_find(ifcp, 'N') != NULL)
765 return;
767 /* -T: generate default route only */
768 if (iff_find(ifcp, 'T') != NULL) {
769 struct netinfo6 rrt_info;
770 memset(&rrt_info, 0, sizeof(struct netinfo6));
771 rrt_info.rip6_dest = in6addr_any;
772 rrt_info.rip6_plen = 0;
773 rrt_info.rip6_metric = 1;
774 rrt_info.rip6_metric += ifcp->ifc_metric;
775 rrt_info.rip6_tag = htons(routetag & 0xffff);
776 np = ripbuf->rip6_nets;
777 *np = rrt_info;
778 nrt = 1;
779 ripflush(ifcp, sin);
780 return;
783 maxrte = (ifcp->ifc_mtu - sizeof(struct ip6_hdr) -
784 sizeof(struct udphdr) -
785 sizeof(struct rip6) + sizeof(struct netinfo6)) /
786 sizeof(struct netinfo6);
788 nrt = 0; np = ripbuf->rip6_nets; nh = NULL;
789 for (rrt = riprt; rrt; rrt = rrt->rrt_next) {
790 if (rrt->rrt_rflags & RRTF_NOADVERTISE)
791 continue;
793 /* Need to check filter here */
794 if (out_filter(rrt, ifcp) == 0)
795 continue;
797 /* Check split horizon and other conditions */
798 if (tobeadv(rrt, ifcp) == 0)
799 continue;
801 /* Only considers the routes with flag if specified */
802 if ((flag & RRTF_CHANGED) &&
803 (rrt->rrt_rflags & RRTF_CHANGED) == 0)
804 continue;
806 /* Check nexthop */
807 if (rrt->rrt_index == ifcp->ifc_index &&
808 !IN6_IS_ADDR_UNSPECIFIED(&rrt->rrt_gw) &&
809 (rrt->rrt_rflags & RRTF_NH_NOT_LLADDR) == 0) {
810 if (nh == NULL || !IN6_ARE_ADDR_EQUAL(nh, &rrt->rrt_gw)) {
811 if (nrt == maxrte - 2)
812 ripflush(ifcp, sin);
813 np->rip6_dest = rrt->rrt_gw;
814 if (IN6_IS_ADDR_LINKLOCAL(&np->rip6_dest))
815 SET_IN6_LINKLOCAL_IFINDEX(np->rip6_dest, 0);
816 np->rip6_plen = 0;
817 np->rip6_tag = 0;
818 np->rip6_metric = NEXTHOP_METRIC;
819 nh = &rrt->rrt_gw;
820 np++; nrt++;
822 } else if (nh && (rrt->rrt_index != ifcp->ifc_index ||
823 !IN6_ARE_ADDR_EQUAL(nh, &rrt->rrt_gw) ||
824 rrt->rrt_rflags & RRTF_NH_NOT_LLADDR)) {
825 /* Reset nexthop */
826 if (nrt == maxrte - 2)
827 ripflush(ifcp, sin);
828 memset(np, 0, sizeof(struct netinfo6));
829 np->rip6_metric = NEXTHOP_METRIC;
830 nh = NULL;
831 np++; nrt++;
834 /* Put the route to the buffer */
835 *np = rrt->rrt_info;
836 np++; nrt++;
837 if (nrt == maxrte) {
838 ripflush(ifcp, sin);
839 nh = NULL;
842 if (nrt) /* Send last packet */
843 ripflush(ifcp, sin);
847 * outbound filter logic, per-route/interface.
850 out_filter(struct riprt *rrt, struct ifc *ifcp)
852 struct iff *iffp;
853 struct in6_addr ia;
854 int ok;
857 * -A: filter out less specific routes, if we have aggregated
858 * route configured.
860 for (iffp = ifcp->ifc_filter; iffp; iffp = iffp->iff_next) {
861 if (iffp->iff_type != 'A')
862 continue;
863 if (rrt->rrt_info.rip6_plen <= iffp->iff_plen)
864 continue;
865 ia = rrt->rrt_info.rip6_dest;
866 applyplen(&ia, iffp->iff_plen);
867 if (IN6_ARE_ADDR_EQUAL(&ia, &iffp->iff_addr))
868 return 0;
872 * if it is an aggregated route, advertise it only to the
873 * interfaces specified on -A.
875 if ((rrt->rrt_rflags & RRTF_AGGREGATE) != 0) {
876 ok = 0;
877 for (iffp = ifcp->ifc_filter; iffp; iffp = iffp->iff_next) {
878 if (iffp->iff_type != 'A')
879 continue;
880 if (rrt->rrt_info.rip6_plen == iffp->iff_plen &&
881 IN6_ARE_ADDR_EQUAL(&rrt->rrt_info.rip6_dest,
882 &iffp->iff_addr)) {
883 ok = 1;
884 break;
887 if (!ok)
888 return 0;
892 * -O: advertise only if prefix matches the configured prefix.
894 if (iff_find(ifcp, 'O')) {
895 ok = 0;
896 for (iffp = ifcp->ifc_filter; iffp; iffp = iffp->iff_next) {
897 if (iffp->iff_type != 'O')
898 continue;
899 if (rrt->rrt_info.rip6_plen < iffp->iff_plen)
900 continue;
901 ia = rrt->rrt_info.rip6_dest;
902 applyplen(&ia, iffp->iff_plen);
903 if (IN6_ARE_ADDR_EQUAL(&ia, &iffp->iff_addr)) {
904 ok = 1;
905 break;
908 if (!ok)
909 return 0;
912 /* the prefix should be advertised */
913 return 1;
917 * Determine if the route is to be advertised on the specified interface.
918 * It checks options specified in the arguments and the split horizon rule.
921 tobeadv(struct riprt *rrt, struct ifc *ifcp)
924 /* Special care for static routes */
925 if (rrt->rrt_flags & RTF_STATIC) {
926 /* XXX don't advertise reject/blackhole routes */
927 if (rrt->rrt_flags & (RTF_REJECT | RTF_BLACKHOLE))
928 return 0;
930 if (Sflag) /* Yes, advertise it anyway */
931 return 1;
932 if (sflag && rrt->rrt_index != ifcp->ifc_index)
933 return 1;
934 return 0;
936 /* Regular split horizon */
937 if (hflag == 0 && rrt->rrt_index == ifcp->ifc_index)
938 return 0;
939 return 1;
943 * Send a rip packet actually.
946 sendpacket(struct sockaddr_in6 *sin, int len)
949 * MSG_DONTROUTE should not be specified when it responds with a
950 * RIP6_REQUEST message. SO_DONTROUTE has been specified to
951 * other sockets.
953 struct msghdr m;
954 struct cmsghdr *cm;
955 struct iovec iov[2];
956 u_char cmsgbuf[256];
957 struct in6_pktinfo *pi;
958 int idx;
959 struct sockaddr_in6 sincopy;
961 /* do not overwrite the given sin */
962 sincopy = *sin;
963 sin = &sincopy;
965 if (IN6_IS_ADDR_LINKLOCAL(&sin->sin6_addr)
966 || IN6_IS_ADDR_MULTICAST(&sin->sin6_addr)) {
967 idx = IN6_LINKLOCAL_IFINDEX(sin->sin6_addr);
968 SET_IN6_LINKLOCAL_IFINDEX(sin->sin6_addr, 0);
969 } else
970 idx = 0;
972 m.msg_name = (caddr_t)sin;
973 m.msg_namelen = sizeof(*sin);
974 iov[0].iov_base = (caddr_t)ripbuf;
975 iov[0].iov_len = len;
976 m.msg_iov = iov;
977 m.msg_iovlen = 1;
978 if (!idx) {
979 m.msg_control = NULL;
980 m.msg_controllen = 0;
981 } else {
982 memset(cmsgbuf, 0, sizeof(cmsgbuf));
983 cm = (struct cmsghdr *)cmsgbuf;
984 m.msg_control = (caddr_t)cm;
985 m.msg_controllen = CMSG_SPACE(sizeof(struct in6_pktinfo));
987 cm->cmsg_len = CMSG_LEN(sizeof(struct in6_pktinfo));
988 cm->cmsg_level = IPPROTO_IPV6;
989 cm->cmsg_type = IPV6_PKTINFO;
990 pi = (struct in6_pktinfo *)CMSG_DATA(cm);
991 memset(&pi->ipi6_addr, 0, sizeof(pi->ipi6_addr)); /*::*/
992 pi->ipi6_ifindex = idx;
995 if (sendmsg(ripsock, &m, 0 /*MSG_DONTROUTE*/) < 0) {
996 trace(1, "sendmsg: %s\n", strerror(errno));
997 return errno;
1000 return 0;
1004 * Receive and process RIP packets. Update the routes/kernel forwarding
1005 * table if necessary.
1007 void
1008 riprecv(void)
1010 struct ifc *ifcp, *ic;
1011 struct sockaddr_in6 fsock;
1012 struct in6_addr nh; /* next hop */
1013 struct rip6 *rp;
1014 struct netinfo6 *np, *nq;
1015 struct riprt *rrt;
1016 int len, nn, need_trigger, idx;
1017 char buf[4 * RIP6_MAXMTU];
1018 time_t t;
1019 struct msghdr m;
1020 struct cmsghdr *cm;
1021 struct iovec iov[2];
1022 u_char cmsgbuf[256];
1023 struct in6_pktinfo *pi;
1024 struct iff *iffp;
1025 struct in6_addr ia;
1026 int ok;
1027 time_t t_half_lifetime;
1029 need_trigger = 0;
1031 m.msg_name = (caddr_t)&fsock;
1032 m.msg_namelen = sizeof(fsock);
1033 iov[0].iov_base = (caddr_t)buf;
1034 iov[0].iov_len = sizeof(buf);
1035 m.msg_iov = iov;
1036 m.msg_iovlen = 1;
1037 cm = (struct cmsghdr *)cmsgbuf;
1038 m.msg_control = (caddr_t)cm;
1039 m.msg_controllen = sizeof(cmsgbuf);
1040 if ((len = recvmsg(ripsock, &m, 0)) < 0) {
1041 fatal("recvmsg");
1042 /*NOTREACHED*/
1044 idx = 0;
1045 for (cm = (struct cmsghdr *)CMSG_FIRSTHDR(&m);
1047 cm = (struct cmsghdr *)CMSG_NXTHDR(&m, cm)) {
1048 if (cm->cmsg_level == IPPROTO_IPV6 &&
1049 cm->cmsg_type == IPV6_PKTINFO) {
1050 pi = (struct in6_pktinfo *)(CMSG_DATA(cm));
1051 idx = pi->ipi6_ifindex;
1052 break;
1055 if (idx && IN6_IS_ADDR_LINKLOCAL(&fsock.sin6_addr))
1056 SET_IN6_LINKLOCAL_IFINDEX(fsock.sin6_addr, idx);
1058 nh = fsock.sin6_addr;
1059 nn = (len - sizeof(struct rip6) + sizeof(struct netinfo6)) /
1060 sizeof(struct netinfo6);
1061 rp = (struct rip6 *)buf;
1062 np = rp->rip6_nets;
1064 if (rp->rip6_vers != RIP6_VERSION) {
1065 trace(1, "Incorrect RIP version %d\n", rp->rip6_vers);
1066 return;
1068 if (rp->rip6_cmd == RIP6_REQUEST) {
1069 if (idx && idx < nindex2ifc) {
1070 ifcp = index2ifc[idx];
1071 riprequest(ifcp, np, nn, &fsock);
1072 } else {
1073 riprequest(NULL, np, nn, &fsock);
1075 return;
1078 if (!IN6_IS_ADDR_LINKLOCAL(&fsock.sin6_addr)) {
1079 trace(1, "Packets from non-ll addr: %s\n",
1080 inet6_n2p(&fsock.sin6_addr));
1081 return; /* Ignore packets from non-link-local addr */
1083 idx = IN6_LINKLOCAL_IFINDEX(fsock.sin6_addr);
1084 ifcp = (idx < nindex2ifc) ? index2ifc[idx] : NULL;
1085 if (!ifcp) {
1086 trace(1, "Packets to unknown interface index %d\n", idx);
1087 return; /* Ignore it */
1089 if (IN6_ARE_ADDR_EQUAL(&ifcp->ifc_mylladdr, &fsock.sin6_addr))
1090 return; /* The packet is from me; ignore */
1091 if (rp->rip6_cmd != RIP6_RESPONSE) {
1092 trace(1, "Invalid command %d\n", rp->rip6_cmd);
1093 return;
1096 /* -N: no use */
1097 if (iff_find(ifcp, 'N') != NULL)
1098 return;
1100 tracet(1, "Recv(%s): from %s.%d info(%d)\n",
1101 ifcp->ifc_name, inet6_n2p(&nh), ntohs(fsock.sin6_port), nn);
1103 t = time(NULL);
1104 t_half_lifetime = t - (RIP_LIFETIME/2);
1105 for (; nn; nn--, np++) {
1106 if (np->rip6_metric == NEXTHOP_METRIC) {
1107 /* modify neighbor address */
1108 if (IN6_IS_ADDR_LINKLOCAL(&np->rip6_dest)) {
1109 nh = np->rip6_dest;
1110 SET_IN6_LINKLOCAL_IFINDEX(nh, idx);
1111 trace(1, "\tNexthop: %s\n", inet6_n2p(&nh));
1112 } else if (IN6_IS_ADDR_UNSPECIFIED(&np->rip6_dest)) {
1113 nh = fsock.sin6_addr;
1114 trace(1, "\tNexthop: %s\n", inet6_n2p(&nh));
1115 } else {
1116 nh = fsock.sin6_addr;
1117 trace(1, "\tInvalid Nexthop: %s\n",
1118 inet6_n2p(&np->rip6_dest));
1120 continue;
1122 if (IN6_IS_ADDR_MULTICAST(&np->rip6_dest)) {
1123 trace(1, "\tMulticast netinfo6: %s/%d [%d]\n",
1124 inet6_n2p(&np->rip6_dest),
1125 np->rip6_plen, np->rip6_metric);
1126 continue;
1128 if (IN6_IS_ADDR_LOOPBACK(&np->rip6_dest)) {
1129 trace(1, "\tLoopback netinfo6: %s/%d [%d]\n",
1130 inet6_n2p(&np->rip6_dest),
1131 np->rip6_plen, np->rip6_metric);
1132 continue;
1134 if (IN6_IS_ADDR_LINKLOCAL(&np->rip6_dest)) {
1135 trace(1, "\tLink Local netinfo6: %s/%d [%d]\n",
1136 inet6_n2p(&np->rip6_dest),
1137 np->rip6_plen, np->rip6_metric);
1138 continue;
1140 /* may need to pass sitelocal prefix in some case, however*/
1141 if (IN6_IS_ADDR_SITELOCAL(&np->rip6_dest) && !lflag) {
1142 trace(1, "\tSite Local netinfo6: %s/%d [%d]\n",
1143 inet6_n2p(&np->rip6_dest),
1144 np->rip6_plen, np->rip6_metric);
1145 continue;
1147 trace(2, "\tnetinfo6: %s/%d [%d]",
1148 inet6_n2p(&np->rip6_dest),
1149 np->rip6_plen, np->rip6_metric);
1150 if (np->rip6_tag)
1151 trace(2, " tag=0x%04x", ntohs(np->rip6_tag) & 0xffff);
1152 if (dflag >= 2) {
1153 ia = np->rip6_dest;
1154 applyplen(&ia, np->rip6_plen);
1155 if (!IN6_ARE_ADDR_EQUAL(&ia, &np->rip6_dest))
1156 trace(2, " [junk outside prefix]");
1160 * -L: listen only if the prefix matches the configuration
1162 ok = 1; /* if there's no L filter, it is ok */
1163 for (iffp = ifcp->ifc_filter; iffp; iffp = iffp->iff_next) {
1164 if (iffp->iff_type != 'L')
1165 continue;
1166 ok = 0;
1167 if (np->rip6_plen < iffp->iff_plen)
1168 continue;
1169 /* special rule: ::/0 means default, not "in /0" */
1170 if (iffp->iff_plen == 0 && np->rip6_plen > 0)
1171 continue;
1172 ia = np->rip6_dest;
1173 applyplen(&ia, iffp->iff_plen);
1174 if (IN6_ARE_ADDR_EQUAL(&ia, &iffp->iff_addr)) {
1175 ok = 1;
1176 break;
1179 if (!ok) {
1180 trace(2, " (filtered)\n");
1181 continue;
1184 trace(2, "\n");
1185 np->rip6_metric++;
1186 np->rip6_metric += ifcp->ifc_metric;
1187 if (np->rip6_metric > HOPCNT_INFINITY6)
1188 np->rip6_metric = HOPCNT_INFINITY6;
1190 applyplen(&np->rip6_dest, np->rip6_plen);
1191 if ((rrt = rtsearch(np, NULL)) != NULL) {
1192 if (rrt->rrt_t == 0)
1193 continue; /* Intf route has priority */
1194 nq = &rrt->rrt_info;
1195 if (nq->rip6_metric > np->rip6_metric) {
1196 if (rrt->rrt_index == ifcp->ifc_index &&
1197 IN6_ARE_ADDR_EQUAL(&nh, &rrt->rrt_gw)) {
1198 /* Small metric from the same gateway */
1199 nq->rip6_metric = np->rip6_metric;
1200 } else {
1201 /* Better route found */
1202 rrt->rrt_index = ifcp->ifc_index;
1203 /* Update routing table */
1204 delroute(nq, &rrt->rrt_gw);
1205 rrt->rrt_gw = nh;
1206 *nq = *np;
1207 addroute(rrt, &nh, ifcp);
1209 rrt->rrt_rflags |= RRTF_CHANGED;
1210 rrt->rrt_t = t;
1211 need_trigger = 1;
1212 } else if (nq->rip6_metric < np->rip6_metric &&
1213 rrt->rrt_index == ifcp->ifc_index &&
1214 IN6_ARE_ADDR_EQUAL(&nh, &rrt->rrt_gw)) {
1215 /* Got worse route from same gw */
1216 nq->rip6_metric = np->rip6_metric;
1217 rrt->rrt_t = t;
1218 rrt->rrt_rflags |= RRTF_CHANGED;
1219 need_trigger = 1;
1220 } else if (nq->rip6_metric == np->rip6_metric &&
1221 np->rip6_metric < HOPCNT_INFINITY6) {
1222 if (rrt->rrt_index == ifcp->ifc_index &&
1223 IN6_ARE_ADDR_EQUAL(&nh, &rrt->rrt_gw)) {
1224 /* same metric, same route from same gw */
1225 rrt->rrt_t = t;
1226 } else if (rrt->rrt_t < t_half_lifetime) {
1227 /* Better route found */
1228 rrt->rrt_index = ifcp->ifc_index;
1229 /* Update routing table */
1230 delroute(nq, &rrt->rrt_gw);
1231 rrt->rrt_gw = nh;
1232 *nq = *np;
1233 addroute(rrt, &nh, ifcp);
1234 rrt->rrt_rflags |= RRTF_CHANGED;
1235 rrt->rrt_t = t;
1239 * if nq->rip6_metric == HOPCNT_INFINITY6 then
1240 * do not update age value. Do nothing.
1242 } else if (np->rip6_metric < HOPCNT_INFINITY6) {
1243 /* Got a new valid route */
1244 if ((rrt = MALLOC(struct riprt)) == NULL) {
1245 fatal("malloc: struct riprt");
1246 /*NOTREACHED*/
1248 memset(rrt, 0, sizeof(*rrt));
1249 nq = &rrt->rrt_info;
1251 rrt->rrt_same = NULL;
1252 rrt->rrt_index = ifcp->ifc_index;
1253 rrt->rrt_flags = RTF_UP|RTF_GATEWAY;
1254 rrt->rrt_gw = nh;
1255 *nq = *np;
1256 applyplen(&nq->rip6_dest, nq->rip6_plen);
1257 if (nq->rip6_plen == sizeof(struct in6_addr) * 8)
1258 rrt->rrt_flags |= RTF_HOST;
1260 /* Put the route to the list */
1261 rrt->rrt_next = riprt;
1262 riprt = rrt;
1263 /* Update routing table */
1264 addroute(rrt, &nh, ifcp);
1265 rrt->rrt_rflags |= RRTF_CHANGED;
1266 need_trigger = 1;
1267 rrt->rrt_t = t;
1270 /* XXX need to care the interval between triggered updates */
1271 if (need_trigger) {
1272 if (nextalarm > time(NULL) + RIP_TRIG_INT6_MAX) {
1273 for (ic = ifc; ic; ic = ic->ifc_next) {
1274 if (ifcp->ifc_index == ic->ifc_index)
1275 continue;
1276 if (ic->ifc_flags & IFF_UP)
1277 ripsend(ic, &ic->ifc_ripsin,
1278 RRTF_CHANGED);
1281 /* Reset the flag */
1282 for (rrt = riprt; rrt; rrt = rrt->rrt_next)
1283 rrt->rrt_rflags &= ~RRTF_CHANGED;
1288 * Send all routes request packet to the specified interface.
1290 void
1291 sendrequest(struct ifc *ifcp)
1293 struct netinfo6 *np;
1294 int error;
1296 if (ifcp->ifc_flags & IFF_LOOPBACK)
1297 return;
1298 ripbuf->rip6_cmd = RIP6_REQUEST;
1299 np = ripbuf->rip6_nets;
1300 memset(np, 0, sizeof(struct netinfo6));
1301 np->rip6_metric = HOPCNT_INFINITY6;
1302 tracet(1, "Send rtdump Request to %s (%s)\n",
1303 ifcp->ifc_name, inet6_n2p(&ifcp->ifc_ripsin.sin6_addr));
1304 error = sendpacket(&ifcp->ifc_ripsin, RIPSIZE(1));
1305 if (error == EAFNOSUPPORT) {
1306 /* Protocol not supported */
1307 tracet(1, "Could not send rtdump Request to %s (%s): "
1308 "set IFF_UP to 0\n",
1309 ifcp->ifc_name, inet6_n2p(&ifcp->ifc_ripsin.sin6_addr));
1310 ifcp->ifc_flags &= ~IFF_UP; /* As if down for AF_INET6 */
1312 ripbuf->rip6_cmd = RIP6_RESPONSE;
1316 * Process a RIP6_REQUEST packet.
1318 void
1319 riprequest(struct ifc *ifcp, struct netinfo6 *np, int nn,
1320 struct sockaddr_in6 *sin)
1322 int i;
1323 struct riprt *rrt;
1325 if (!(nn == 1 && IN6_IS_ADDR_UNSPECIFIED(&np->rip6_dest) &&
1326 np->rip6_plen == 0 && np->rip6_metric == HOPCNT_INFINITY6)) {
1327 /* Specific response, don't split-horizon */
1328 trace(1, "\tRIP Request\n");
1329 for (i = 0; i < nn; i++, np++) {
1330 rrt = rtsearch(np, NULL);
1331 if (rrt)
1332 np->rip6_metric = rrt->rrt_info.rip6_metric;
1333 else
1334 np->rip6_metric = HOPCNT_INFINITY6;
1336 sendpacket(sin, RIPSIZE(nn));
1337 return;
1339 /* Whole routing table dump */
1340 trace(1, "\tRIP Request -- whole routing table\n");
1341 ripsend(ifcp, sin, RRTF_SENDANYWAY);
1345 * Get information of each interface.
1347 void
1348 ifconfig(void)
1350 struct ifaddrs *ifap, *ifa;
1351 struct ifc *ifcp;
1352 struct ipv6_mreq mreq;
1353 int s;
1355 if ((s = socket(AF_INET6, SOCK_DGRAM, 0)) < 0) {
1356 fatal("socket");
1357 /*NOTREACHED*/
1360 if (getifaddrs(&ifap) != 0) {
1361 fatal("getifaddrs");
1362 /*NOTREACHED*/
1365 for (ifa = ifap; ifa; ifa = ifa->ifa_next) {
1366 if (ifa->ifa_addr->sa_family != AF_INET6)
1367 continue;
1368 ifcp = ifc_find(ifa->ifa_name);
1369 /* we are interested in multicast-capable interfaces */
1370 if ((ifa->ifa_flags & IFF_MULTICAST) == 0)
1371 continue;
1372 if (!ifcp) {
1373 /* new interface */
1374 if ((ifcp = MALLOC(struct ifc)) == NULL) {
1375 fatal("malloc: struct ifc");
1376 /*NOTREACHED*/
1378 memset(ifcp, 0, sizeof(*ifcp));
1379 ifcp->ifc_index = -1;
1380 ifcp->ifc_next = ifc;
1381 ifc = ifcp;
1382 nifc++;
1383 ifcp->ifc_name = allocopy(ifa->ifa_name);
1384 ifcp->ifc_addr = 0;
1385 ifcp->ifc_filter = 0;
1386 ifcp->ifc_flags = ifa->ifa_flags;
1387 trace(1, "newif %s <%s>\n", ifcp->ifc_name,
1388 ifflags(ifcp->ifc_flags));
1389 if (!strcmp(ifcp->ifc_name, LOOPBACK_IF))
1390 loopifcp = ifcp;
1391 } else {
1392 /* update flag, this may be up again */
1393 if (ifcp->ifc_flags != ifa->ifa_flags) {
1394 trace(1, "%s: <%s> -> ", ifcp->ifc_name,
1395 ifflags(ifcp->ifc_flags));
1396 trace(1, "<%s>\n", ifflags(ifa->ifa_flags));
1397 ifcp->ifc_cflags |= IFC_CHANGED;
1399 ifcp->ifc_flags = ifa->ifa_flags;
1401 ifconfig1(ifa->ifa_name, ifa->ifa_addr, ifcp, s);
1402 if ((ifcp->ifc_flags & (IFF_LOOPBACK | IFF_UP)) == IFF_UP
1403 && 0 < ifcp->ifc_index && !ifcp->ifc_joined) {
1404 mreq.ipv6mr_multiaddr = ifcp->ifc_ripsin.sin6_addr;
1405 mreq.ipv6mr_interface = ifcp->ifc_index;
1406 if (setsockopt(ripsock, IPPROTO_IPV6, IPV6_JOIN_GROUP,
1407 &mreq, sizeof(mreq)) < 0) {
1408 fatal("IPV6_JOIN_GROUP");
1409 /*NOTREACHED*/
1411 trace(1, "join %s %s\n", ifcp->ifc_name, RIP6_DEST);
1412 ifcp->ifc_joined++;
1415 close(s);
1416 freeifaddrs(ifap);
1419 void
1420 ifconfig1(const char *name, const struct sockaddr *sa, struct ifc *ifcp, int s)
1422 struct in6_ifreq ifr;
1423 const struct sockaddr_in6 *sin;
1424 struct ifac *ifa;
1425 int plen;
1426 char buf[BUFSIZ];
1428 sin = (const struct sockaddr_in6 *)sa;
1429 ifr.ifr_addr = *sin;
1430 strcpy(ifr.ifr_name, name);
1431 if (ioctl(s, SIOCGIFNETMASK_IN6, (char *)&ifr) < 0) {
1432 fatal("ioctl: SIOCGIFNETMASK_IN6");
1433 /*NOTREACHED*/
1435 plen = sin6mask2len(&ifr.ifr_addr);
1436 if ((ifa = ifa_match(ifcp, &sin->sin6_addr, plen)) != NULL) {
1437 /* same interface found */
1438 /* need check if something changed */
1439 /* XXX not yet implemented */
1440 return;
1443 * New address is found
1445 if ((ifa = MALLOC(struct ifac)) == NULL) {
1446 fatal("malloc: struct ifac");
1447 /*NOTREACHED*/
1449 memset(ifa, 0, sizeof(*ifa));
1450 ifa->ifa_conf = ifcp;
1451 ifa->ifa_next = ifcp->ifc_addr;
1452 ifcp->ifc_addr = ifa;
1453 ifa->ifa_addr = sin->sin6_addr;
1454 ifa->ifa_plen = plen;
1455 if (ifcp->ifc_flags & IFF_POINTOPOINT) {
1456 ifr.ifr_addr = *sin;
1457 if (ioctl(s, SIOCGIFDSTADDR_IN6, (char *)&ifr) < 0) {
1458 fatal("ioctl: SIOCGIFDSTADDR_IN6");
1459 /*NOTREACHED*/
1461 ifa->ifa_raddr = ifr.ifr_dstaddr.sin6_addr;
1462 inet_ntop(AF_INET6, (void *)&ifa->ifa_raddr, buf, sizeof(buf));
1463 trace(1, "found address %s/%d -- %s\n",
1464 inet6_n2p(&ifa->ifa_addr), ifa->ifa_plen, buf);
1465 } else {
1466 trace(1, "found address %s/%d\n",
1467 inet6_n2p(&ifa->ifa_addr), ifa->ifa_plen);
1469 if (ifcp->ifc_index < 0 && IN6_IS_ADDR_LINKLOCAL(&ifa->ifa_addr)) {
1470 ifcp->ifc_mylladdr = ifa->ifa_addr;
1471 ifcp->ifc_index = IN6_LINKLOCAL_IFINDEX(ifa->ifa_addr);
1472 memcpy(&ifcp->ifc_ripsin, &ripsin, ripsin.ss_len);
1473 SET_IN6_LINKLOCAL_IFINDEX(ifcp->ifc_ripsin.sin6_addr,
1474 ifcp->ifc_index);
1475 setindex2ifc(ifcp->ifc_index, ifcp);
1476 ifcp->ifc_mtu = getifmtu(ifcp->ifc_index);
1477 if (ifcp->ifc_mtu > RIP6_MAXMTU)
1478 ifcp->ifc_mtu = RIP6_MAXMTU;
1479 if (ioctl(s, SIOCGIFMETRIC, (char *)&ifr) < 0) {
1480 fatal("ioctl: SIOCGIFMETRIC");
1481 /*NOTREACHED*/
1483 ifcp->ifc_metric = ifr.ifr_metric;
1484 trace(1, "\tindex: %d, mtu: %d, metric: %d\n",
1485 ifcp->ifc_index, ifcp->ifc_mtu, ifcp->ifc_metric);
1486 } else
1487 ifcp->ifc_cflags |= IFC_CHANGED;
1491 * Receive and process routing messages.
1492 * Update interface information as necesssary.
1494 void
1495 rtrecv(void)
1497 char buf[BUFSIZ];
1498 char *p, *q;
1499 struct rt_msghdr *rtm;
1500 struct ifa_msghdr *ifam;
1501 struct if_msghdr *ifm;
1502 int len;
1503 struct ifc *ifcp, *ic;
1504 int iface = 0, rtable = 0;
1505 struct sockaddr_in6 *rta[RTAX_MAX];
1506 struct sockaddr_in6 mask;
1507 int i, addrs;
1508 struct riprt *rrt;
1510 if ((len = read(rtsock, buf, sizeof(buf))) < 0) {
1511 perror("read from rtsock");
1512 exit(1);
1514 if (len < sizeof(*rtm)) {
1515 trace(1, "short read from rtsock: %d (should be > %lu)\n",
1516 len, (u_long)sizeof(*rtm));
1517 return;
1520 for (p = buf; p - buf < len; p += ((struct rt_msghdr *)p)->rtm_msglen) {
1521 /* safety against bogus message */
1522 if (((struct rt_msghdr *)p)->rtm_msglen <= 0) {
1523 trace(1, "bogus rtmsg: length=%d\n",
1524 ((struct rt_msghdr *)p)->rtm_msglen);
1525 break;
1527 rtm = NULL;
1528 ifam = NULL;
1529 ifm = NULL;
1530 switch (((struct rt_msghdr *)p)->rtm_type) {
1531 case RTM_NEWADDR:
1532 case RTM_DELADDR:
1533 ifam = (struct ifa_msghdr *)p;
1534 addrs = ifam->ifam_addrs;
1535 q = (char *)(ifam + 1);
1536 break;
1537 case RTM_IFINFO:
1538 ifm = (struct if_msghdr *)p;
1539 addrs = ifm->ifm_addrs;
1540 q = (char *)(ifm + 1);
1541 break;
1542 default:
1543 rtm = (struct rt_msghdr *)p;
1544 addrs = rtm->rtm_addrs;
1545 q = (char *)(rtm + 1);
1546 if (rtm->rtm_version != RTM_VERSION) {
1547 trace(1, "unexpected rtmsg version %d "
1548 "(should be %d)\n",
1549 rtm->rtm_version, RTM_VERSION);
1550 continue;
1552 if (rtm->rtm_pid == pid) {
1553 #if 0
1554 trace(1, "rtmsg looped back to me, ignored\n");
1555 #endif
1556 continue;
1558 break;
1560 memset(&rta, 0, sizeof(rta));
1561 for (i = 0; i < RTAX_MAX; i++) {
1562 if (addrs & (1 << i)) {
1563 rta[i] = (struct sockaddr_in6 *)q;
1564 q += ROUNDUP(rta[i]->sin6_len);
1568 trace(1, "rtsock: %s (addrs=%x)\n",
1569 rttypes((struct rt_msghdr *)p), addrs);
1570 if (dflag >= 2) {
1571 for (i = 0;
1572 i < ((struct rt_msghdr *)p)->rtm_msglen;
1573 i++) {
1574 fprintf(stderr, "%02x ", p[i] & 0xff);
1575 if (i % 16 == 15) fprintf(stderr, "\n");
1577 fprintf(stderr, "\n");
1581 * Easy ones first.
1583 * We may be able to optimize by using ifm->ifm_index or
1584 * ifam->ifam_index. For simplicity we don't do that here.
1586 switch (((struct rt_msghdr *)p)->rtm_type) {
1587 case RTM_NEWADDR:
1588 case RTM_IFINFO:
1589 iface++;
1590 continue;
1591 case RTM_ADD:
1592 rtable++;
1593 continue;
1594 case RTM_LOSING:
1595 case RTM_MISS:
1596 case RTM_RESOLVE:
1597 case RTM_GET:
1598 case RTM_LOCK:
1599 /* nothing to be done here */
1600 trace(1, "\tnothing to be done, ignored\n");
1601 continue;
1604 #if 0
1605 if (rta[RTAX_DST] == NULL) {
1606 trace(1, "\tno destination, ignored\n");
1607 continue;
1609 if (rta[RTAX_DST]->sin6_family != AF_INET6) {
1610 trace(1, "\taf mismatch, ignored\n");
1611 continue;
1613 if (IN6_IS_ADDR_LINKLOCAL(&rta[RTAX_DST]->sin6_addr)) {
1614 trace(1, "\tlinklocal destination, ignored\n");
1615 continue;
1617 if (IN6_ARE_ADDR_EQUAL(&rta[RTAX_DST]->sin6_addr, &in6addr_loopback)) {
1618 trace(1, "\tloopback destination, ignored\n");
1619 continue; /* Loopback */
1621 if (IN6_IS_ADDR_MULTICAST(&rta[RTAX_DST]->sin6_addr)) {
1622 trace(1, "\tmulticast destination, ignored\n");
1623 continue;
1625 #endif
1627 /* hard ones */
1628 switch (((struct rt_msghdr *)p)->rtm_type) {
1629 case RTM_NEWADDR:
1630 case RTM_IFINFO:
1631 case RTM_ADD:
1632 case RTM_LOSING:
1633 case RTM_MISS:
1634 case RTM_RESOLVE:
1635 case RTM_GET:
1636 case RTM_LOCK:
1637 /* should already be handled */
1638 fatal("rtrecv: never reach here");
1639 /*NOTREACHED*/
1640 case RTM_DELETE:
1641 if (!rta[RTAX_DST] || !rta[RTAX_GATEWAY]) {
1642 trace(1, "\tsome of dst/gw/netamsk are "
1643 "unavailable, ignored\n");
1644 break;
1646 if ((rtm->rtm_flags & RTF_HOST) != 0) {
1647 mask.sin6_len = sizeof(mask);
1648 memset(&mask.sin6_addr, 0xff,
1649 sizeof(mask.sin6_addr));
1650 rta[RTAX_NETMASK] = &mask;
1651 } else if (!rta[RTAX_NETMASK]) {
1652 trace(1, "\tsome of dst/gw/netamsk are "
1653 "unavailable, ignored\n");
1654 break;
1656 if (rt_del(rta[RTAX_DST], rta[RTAX_GATEWAY],
1657 rta[RTAX_NETMASK]) == 0) {
1658 rtable++; /*just to be sure*/
1660 break;
1661 case RTM_CHANGE:
1662 case RTM_REDIRECT:
1663 trace(1, "\tnot supported yet, ignored\n");
1664 break;
1665 case RTM_DELADDR:
1666 if (!rta[RTAX_NETMASK] || !rta[RTAX_IFA]) {
1667 trace(1, "\tno netmask or ifa given, ignored\n");
1668 break;
1670 if (ifam->ifam_index < nindex2ifc)
1671 ifcp = index2ifc[ifam->ifam_index];
1672 else
1673 ifcp = NULL;
1674 if (!ifcp) {
1675 trace(1, "\tinvalid ifam_index %d, ignored\n",
1676 ifam->ifam_index);
1677 break;
1679 if (!rt_deladdr(ifcp, rta[RTAX_IFA], rta[RTAX_NETMASK]))
1680 iface++;
1681 break;
1682 case RTM_OLDADD:
1683 case RTM_OLDDEL:
1684 trace(1, "\tnot supported yet, ignored\n");
1685 break;
1690 if (iface) {
1691 trace(1, "rtsock: reconfigure interfaces, refresh interface routes\n");
1692 ifconfig();
1693 for (ifcp = ifc; ifcp; ifcp = ifcp->ifc_next)
1694 if (ifcp->ifc_cflags & IFC_CHANGED) {
1695 if (ifrt(ifcp, 1)) {
1696 for (ic = ifc; ic; ic = ic->ifc_next) {
1697 if (ifcp->ifc_index == ic->ifc_index)
1698 continue;
1699 if (ic->ifc_flags & IFF_UP)
1700 ripsend(ic, &ic->ifc_ripsin,
1701 RRTF_CHANGED);
1703 /* Reset the flag */
1704 for (rrt = riprt; rrt; rrt = rrt->rrt_next)
1705 rrt->rrt_rflags &= ~RRTF_CHANGED;
1707 ifcp->ifc_cflags &= ~IFC_CHANGED;
1710 if (rtable) {
1711 trace(1, "rtsock: read routing table again\n");
1712 krtread(1);
1717 * remove specified route from the internal routing table.
1720 rt_del(const struct sockaddr_in6 *sdst, const struct sockaddr_in6 *sgw,
1721 const struct sockaddr_in6 *smask)
1723 const struct in6_addr *dst = NULL;
1724 const struct in6_addr *gw = NULL;
1725 int prefix;
1726 struct netinfo6 ni6;
1727 struct riprt *rrt = NULL;
1728 time_t t_lifetime;
1730 if (sdst->sin6_family != AF_INET6) {
1731 trace(1, "\tother AF, ignored\n");
1732 return -1;
1734 if (IN6_IS_ADDR_LINKLOCAL(&sdst->sin6_addr)
1735 || IN6_ARE_ADDR_EQUAL(&sdst->sin6_addr, &in6addr_loopback)
1736 || IN6_IS_ADDR_MULTICAST(&sdst->sin6_addr)) {
1737 trace(1, "\taddress %s not interesting, ignored\n",
1738 inet6_n2p(&sdst->sin6_addr));
1739 return -1;
1741 dst = &sdst->sin6_addr;
1742 if (sgw->sin6_family == AF_INET6) {
1743 /* easy case */
1744 gw = &sgw->sin6_addr;
1745 prefix = sin6mask2len(smask);
1746 } else if (sgw->sin6_family == AF_LINK) {
1748 * Interface route... a hard case. We need to get the prefix
1749 * length from the kernel, but we now are parsing rtmsg.
1750 * We'll purge matching routes from my list, then get the
1751 * fresh list.
1753 struct riprt *longest;
1754 trace(1, "\t%s is a interface route, guessing prefixlen\n",
1755 inet6_n2p(dst));
1756 longest = NULL;
1757 for (rrt = riprt; rrt; rrt = rrt->rrt_next) {
1758 if (IN6_ARE_ADDR_EQUAL(&rrt->rrt_info.rip6_dest,
1759 &sdst->sin6_addr)
1760 && IN6_IS_ADDR_LOOPBACK(&rrt->rrt_gw)) {
1761 if (!longest
1762 || longest->rrt_info.rip6_plen <
1763 rrt->rrt_info.rip6_plen) {
1764 longest = rrt;
1768 rrt = longest;
1769 if (!rrt) {
1770 trace(1, "\tno matching interface route found\n");
1771 return -1;
1773 gw = &in6addr_loopback;
1774 prefix = rrt->rrt_info.rip6_plen;
1775 } else {
1776 trace(1, "\tunsupported af: (gw=%d)\n", sgw->sin6_family);
1777 return -1;
1780 trace(1, "\tdeleting %s/%d ", inet6_n2p(dst), prefix);
1781 trace(1, "gw %s\n", inet6_n2p(gw));
1782 t_lifetime = time(NULL) - RIP_LIFETIME;
1783 /* age route for interface address */
1784 memset(&ni6, 0, sizeof(ni6));
1785 ni6.rip6_dest = *dst;
1786 ni6.rip6_plen = prefix;
1787 applyplen(&ni6.rip6_dest, ni6.rip6_plen); /*to be sure*/
1788 trace(1, "\tfind route %s/%d\n", inet6_n2p(&ni6.rip6_dest),
1789 ni6.rip6_plen);
1790 if (!rrt && (rrt = rtsearch(&ni6, NULL)) == NULL) {
1791 trace(1, "\tno route found\n");
1792 return -1;
1794 #if 0
1795 if ((rrt->rrt_flags & RTF_STATIC) == 0) {
1796 trace(1, "\tyou can delete static routes only\n");
1797 } else
1798 #endif
1799 if (!IN6_ARE_ADDR_EQUAL(&rrt->rrt_gw, gw)) {
1800 trace(1, "\tgw mismatch: %s <-> ",
1801 inet6_n2p(&rrt->rrt_gw));
1802 trace(1, "%s\n", inet6_n2p(gw));
1803 } else {
1804 trace(1, "\troute found, age it\n");
1805 if (rrt->rrt_t == 0 || rrt->rrt_t > t_lifetime) {
1806 rrt->rrt_t = t_lifetime;
1807 rrt->rrt_info.rip6_metric = HOPCNT_INFINITY6;
1810 return 0;
1814 * remove specified address from internal interface/routing table.
1817 rt_deladdr(struct ifc *ifcp, const struct sockaddr_in6 *sifa,
1818 const struct sockaddr_in6 *smask)
1820 const struct in6_addr *addr = NULL;
1821 int prefix;
1822 struct ifac *ifa = NULL;
1823 struct netinfo6 ni6;
1824 struct riprt *rrt = NULL;
1825 time_t t_lifetime;
1826 int updated = 0;
1828 if (sifa->sin6_family != AF_INET6) {
1829 trace(1, "\tother AF, ignored\n");
1830 return -1;
1832 addr = &sifa->sin6_addr;
1833 prefix = sin6mask2len(smask);
1835 trace(1, "\tdeleting %s/%d from %s\n",
1836 inet6_n2p(addr), prefix, ifcp->ifc_name);
1837 ifa = ifa_match(ifcp, addr, prefix);
1838 if (!ifa) {
1839 trace(1, "\tno matching ifa found for %s/%d on %s\n",
1840 inet6_n2p(addr), prefix, ifcp->ifc_name);
1841 return -1;
1843 if (ifa->ifa_conf != ifcp) {
1844 trace(1, "\taddress table corrupt: back pointer does not match "
1845 "(%s != %s)\n",
1846 ifcp->ifc_name, ifa->ifa_conf->ifc_name);
1847 return -1;
1849 /* remove ifa from interface */
1850 if (ifcp->ifc_addr == ifa)
1851 ifcp->ifc_addr = ifa->ifa_next;
1852 else {
1853 struct ifac *p;
1854 for (p = ifcp->ifc_addr; p; p = p->ifa_next) {
1855 if (p->ifa_next == ifa) {
1856 p->ifa_next = ifa->ifa_next;
1857 break;
1861 ifa->ifa_next = NULL;
1862 ifa->ifa_conf = NULL;
1863 t_lifetime = time(NULL) - RIP_LIFETIME;
1864 /* age route for interface address */
1865 memset(&ni6, 0, sizeof(ni6));
1866 ni6.rip6_dest = ifa->ifa_addr;
1867 ni6.rip6_plen = ifa->ifa_plen;
1868 applyplen(&ni6.rip6_dest, ni6.rip6_plen);
1869 trace(1, "\tfind interface route %s/%d on %d\n",
1870 inet6_n2p(&ni6.rip6_dest), ni6.rip6_plen, ifcp->ifc_index);
1871 if ((rrt = rtsearch(&ni6, NULL)) != NULL) {
1872 struct in6_addr none;
1873 memset(&none, 0, sizeof(none));
1874 if (rrt->rrt_index == ifcp->ifc_index &&
1875 (IN6_ARE_ADDR_EQUAL(&rrt->rrt_gw, &none) ||
1876 IN6_IS_ADDR_LOOPBACK(&rrt->rrt_gw))) {
1877 trace(1, "\troute found, age it\n");
1878 if (rrt->rrt_t == 0 || rrt->rrt_t > t_lifetime) {
1879 rrt->rrt_t = t_lifetime;
1880 rrt->rrt_info.rip6_metric = HOPCNT_INFINITY6;
1882 updated++;
1883 } else {
1884 trace(1, "\tnon-interface route found: %s/%d on %d\n",
1885 inet6_n2p(&rrt->rrt_info.rip6_dest),
1886 rrt->rrt_info.rip6_plen,
1887 rrt->rrt_index);
1889 } else
1890 trace(1, "\tno interface route found\n");
1891 /* age route for p2p destination */
1892 if (ifcp->ifc_flags & IFF_POINTOPOINT) {
1893 memset(&ni6, 0, sizeof(ni6));
1894 ni6.rip6_dest = ifa->ifa_raddr;
1895 ni6.rip6_plen = 128;
1896 applyplen(&ni6.rip6_dest, ni6.rip6_plen); /*to be sure*/
1897 trace(1, "\tfind p2p route %s/%d on %d\n",
1898 inet6_n2p(&ni6.rip6_dest), ni6.rip6_plen,
1899 ifcp->ifc_index);
1900 if ((rrt = rtsearch(&ni6, NULL)) != NULL) {
1901 if (rrt->rrt_index == ifcp->ifc_index &&
1902 IN6_ARE_ADDR_EQUAL(&rrt->rrt_gw, &ifa->ifa_addr)) {
1903 trace(1, "\troute found, age it\n");
1904 if (rrt->rrt_t == 0 || rrt->rrt_t > t_lifetime) {
1905 rrt->rrt_t = t_lifetime;
1906 rrt->rrt_info.rip6_metric =
1907 HOPCNT_INFINITY6;
1908 updated++;
1910 } else {
1911 trace(1, "\tnon-p2p route found: %s/%d on %d\n",
1912 inet6_n2p(&rrt->rrt_info.rip6_dest),
1913 rrt->rrt_info.rip6_plen,
1914 rrt->rrt_index);
1916 } else
1917 trace(1, "\tno p2p route found\n");
1919 return updated ? 0 : -1;
1923 * Get each interface address and put those interface routes to the route
1924 * list.
1927 ifrt(struct ifc *ifcp, int again)
1929 struct ifac *ifa;
1930 struct riprt *rrt, *search_rrt, *prev_rrt, *loop_rrt;
1931 struct netinfo6 *np;
1932 time_t t_lifetime;
1933 int need_trigger = 0;
1935 if (ifcp->ifc_flags & IFF_LOOPBACK)
1936 return 0; /* ignore loopback */
1937 if (ifcp->ifc_flags & IFF_POINTOPOINT) {
1938 ifrt_p2p(ifcp, again);
1939 return 0;
1942 for (ifa = ifcp->ifc_addr; ifa; ifa = ifa->ifa_next) {
1943 if (IN6_IS_ADDR_LINKLOCAL(&ifa->ifa_addr)) {
1944 #if 0
1945 trace(1, "route: %s on %s: "
1946 "skip linklocal interface address\n",
1947 inet6_n2p(&ifa->ifa_addr), ifcp->ifc_name);
1948 #endif
1949 continue;
1951 if (IN6_IS_ADDR_UNSPECIFIED(&ifa->ifa_addr)) {
1952 #if 0
1953 trace(1, "route: %s: skip unspec interface address\n",
1954 ifcp->ifc_name);
1955 #endif
1956 continue;
1958 if (ifcp->ifc_flags & IFF_UP) {
1959 if ((rrt = MALLOC(struct riprt)) == NULL)
1960 fatal("malloc: struct riprt");
1961 memset(rrt, 0, sizeof(*rrt));
1962 rrt->rrt_same = NULL;
1963 rrt->rrt_index = ifcp->ifc_index;
1964 rrt->rrt_t = 0; /* don't age */
1965 rrt->rrt_info.rip6_dest = ifa->ifa_addr;
1966 rrt->rrt_info.rip6_tag = htons(routetag & 0xffff);
1967 rrt->rrt_info.rip6_metric = 1 + ifcp->ifc_metric;
1968 rrt->rrt_info.rip6_plen = ifa->ifa_plen;
1969 rrt->rrt_flags = RTF_CLONING;
1970 rrt->rrt_rflags |= RRTF_CHANGED;
1971 applyplen(&rrt->rrt_info.rip6_dest, ifa->ifa_plen);
1972 memset(&rrt->rrt_gw, 0, sizeof(struct in6_addr));
1973 #if 0
1974 /* XXX why gateway address == network adddress? */
1975 rrt->rrt_gw = ifa->ifa_addr;
1976 #endif
1977 np = &rrt->rrt_info;
1978 search_rrt = rtsearch(np, &prev_rrt);
1979 if (search_rrt != NULL) {
1980 if (search_rrt->rrt_info.rip6_metric >
1981 rrt->rrt_info.rip6_metric) {
1982 if (prev_rrt)
1983 prev_rrt->rrt_next = rrt->rrt_next;
1984 else
1985 riprt = rrt->rrt_next;
1986 delroute(&rrt->rrt_info, &rrt->rrt_gw);
1987 free(rrt);
1988 } else {
1989 /* Already have better route */
1990 if (!again) {
1991 trace(1, "route: %s/%d: "
1992 "already registered (%s)\n",
1993 inet6_n2p(&np->rip6_dest), np->rip6_plen,
1994 ifcp->ifc_name);
1996 free(rrt);
1997 continue;
2000 /* Attach the route to the list */
2001 trace(1, "route: %s/%d: register route (%s)\n",
2002 inet6_n2p(&np->rip6_dest), np->rip6_plen,
2003 ifcp->ifc_name);
2004 rrt->rrt_next = riprt;
2005 riprt = rrt;
2006 addroute(rrt, &rrt->rrt_gw, ifcp);
2007 sendrequest(ifcp);
2008 ripsend(ifcp, &ifcp->ifc_ripsin, 0);
2009 need_trigger = 1;
2010 } else {
2011 for (loop_rrt = riprt; loop_rrt; loop_rrt = loop_rrt->rrt_next) {
2012 if (loop_rrt->rrt_index == ifcp->ifc_index) {
2013 t_lifetime = time(NULL) - RIP_LIFETIME;
2014 if (loop_rrt->rrt_t == 0 || loop_rrt->rrt_t > t_lifetime) {
2015 loop_rrt->rrt_t = t_lifetime;
2016 loop_rrt->rrt_info.rip6_metric = HOPCNT_INFINITY6;
2017 loop_rrt->rrt_rflags |= RRTF_CHANGED;
2018 need_trigger = 1;
2024 return need_trigger;
2028 * there are couple of p2p interface routing models. "behavior" lets
2029 * you pick one. it looks that gated behavior fits best with BSDs,
2030 * since BSD kernels does not look at prefix length on p2p interfaces.
2032 void
2033 ifrt_p2p(struct ifc *ifcp, int again)
2035 struct ifac *ifa;
2036 struct riprt *rrt, *orrt, *prevrrt;
2037 struct netinfo6 *np;
2038 struct in6_addr addr, dest;
2039 int advert, ignore, i;
2040 #define P2PADVERT_NETWORK 1
2041 #define P2PADVERT_ADDR 2
2042 #define P2PADVERT_DEST 4
2043 #define P2PADVERT_MAX 4
2044 const enum { CISCO, GATED, ROUTE6D } behavior = GATED;
2045 const char *category = "";
2046 const char *noadv;
2048 for (ifa = ifcp->ifc_addr; ifa; ifa = ifa->ifa_next) {
2049 addr = ifa->ifa_addr;
2050 dest = ifa->ifa_raddr;
2051 applyplen(&addr, ifa->ifa_plen);
2052 applyplen(&dest, ifa->ifa_plen);
2053 advert = ignore = 0;
2054 switch (behavior) {
2055 case CISCO:
2057 * honor addr/plen, just like normal shared medium
2058 * interface. this may cause trouble if you reuse
2059 * addr/plen on other interfaces.
2061 * advertise addr/plen.
2063 advert |= P2PADVERT_NETWORK;
2064 break;
2065 case GATED:
2067 * prefixlen on p2p interface is meaningless.
2068 * advertise addr/128 and dest/128.
2070 * do not install network route to route6d routing
2071 * table (if we do, it would prevent route installation
2072 * for other p2p interface that shares addr/plen).
2074 * XXX what should we do if dest is ::? it will not
2075 * get announced anyways (see following filter),
2076 * but we need to think.
2078 advert |= P2PADVERT_ADDR;
2079 advert |= P2PADVERT_DEST;
2080 ignore |= P2PADVERT_NETWORK;
2081 break;
2082 case ROUTE6D:
2084 * just for testing. actually the code is redundant
2085 * given the current p2p interface address assignment
2086 * rule for kame kernel.
2088 * intent:
2089 * A/n -> announce A/n
2090 * A B/n, A and B share prefix -> A/n (= B/n)
2091 * A B/n, do not share prefix -> A/128 and B/128
2092 * actually, A/64 and A B/128 are the only cases
2093 * permitted by the kernel:
2094 * A/64 -> A/64
2095 * A B/128 -> A/128 and B/128
2097 if (!IN6_IS_ADDR_UNSPECIFIED(&ifa->ifa_raddr)) {
2098 if (IN6_ARE_ADDR_EQUAL(&addr, &dest))
2099 advert |= P2PADVERT_NETWORK;
2100 else {
2101 advert |= P2PADVERT_ADDR;
2102 advert |= P2PADVERT_DEST;
2103 ignore |= P2PADVERT_NETWORK;
2105 } else
2106 advert |= P2PADVERT_NETWORK;
2107 break;
2110 for (i = 1; i <= P2PADVERT_MAX; i *= 2) {
2111 if ((ignore & i) != 0)
2112 continue;
2113 if ((rrt = MALLOC(struct riprt)) == NULL) {
2114 fatal("malloc: struct riprt");
2115 /*NOTREACHED*/
2117 memset(rrt, 0, sizeof(*rrt));
2118 rrt->rrt_same = NULL;
2119 rrt->rrt_index = ifcp->ifc_index;
2120 rrt->rrt_t = 0; /* don't age */
2121 switch (i) {
2122 case P2PADVERT_NETWORK:
2123 rrt->rrt_info.rip6_dest = ifa->ifa_addr;
2124 rrt->rrt_info.rip6_plen = ifa->ifa_plen;
2125 applyplen(&rrt->rrt_info.rip6_dest,
2126 ifa->ifa_plen);
2127 category = "network";
2128 break;
2129 case P2PADVERT_ADDR:
2130 rrt->rrt_info.rip6_dest = ifa->ifa_addr;
2131 rrt->rrt_info.rip6_plen = 128;
2132 rrt->rrt_gw = in6addr_loopback;
2133 category = "addr";
2134 break;
2135 case P2PADVERT_DEST:
2136 rrt->rrt_info.rip6_dest = ifa->ifa_raddr;
2137 rrt->rrt_info.rip6_plen = 128;
2138 rrt->rrt_gw = ifa->ifa_addr;
2139 category = "dest";
2140 break;
2142 if (IN6_IS_ADDR_UNSPECIFIED(&rrt->rrt_info.rip6_dest) ||
2143 IN6_IS_ADDR_LINKLOCAL(&rrt->rrt_info.rip6_dest)) {
2144 #if 0
2145 trace(1, "route: %s: skip unspec/linklocal "
2146 "(%s on %s)\n", category, ifcp->ifc_name);
2147 #endif
2148 free(rrt);
2149 continue;
2151 if ((advert & i) == 0) {
2152 rrt->rrt_rflags |= RRTF_NOADVERTISE;
2153 noadv = ", NO-ADV";
2154 } else
2155 noadv = "";
2156 rrt->rrt_info.rip6_tag = htons(routetag & 0xffff);
2157 rrt->rrt_info.rip6_metric = 1 + ifcp->ifc_metric;
2158 np = &rrt->rrt_info;
2159 orrt = rtsearch(np, &prevrrt);
2160 if (!orrt) {
2161 /* Attach the route to the list */
2162 trace(1, "route: %s/%d: register route "
2163 "(%s on %s%s)\n",
2164 inet6_n2p(&np->rip6_dest), np->rip6_plen,
2165 category, ifcp->ifc_name, noadv);
2166 rrt->rrt_next = riprt;
2167 riprt = rrt;
2168 } else if (rrt->rrt_index != orrt->rrt_index ||
2169 rrt->rrt_info.rip6_metric != orrt->rrt_info.rip6_metric) {
2170 /* swap route */
2171 rrt->rrt_next = orrt->rrt_next;
2172 if (prevrrt)
2173 prevrrt->rrt_next = rrt;
2174 else
2175 riprt = rrt;
2176 free(orrt);
2178 trace(1, "route: %s/%d: update (%s on %s%s)\n",
2179 inet6_n2p(&np->rip6_dest), np->rip6_plen,
2180 category, ifcp->ifc_name, noadv);
2181 } else {
2182 /* Already found */
2183 if (!again) {
2184 trace(1, "route: %s/%d: "
2185 "already registered (%s on %s%s)\n",
2186 inet6_n2p(&np->rip6_dest),
2187 np->rip6_plen, category,
2188 ifcp->ifc_name, noadv);
2190 free(rrt);
2194 #undef P2PADVERT_NETWORK
2195 #undef P2PADVERT_ADDR
2196 #undef P2PADVERT_DEST
2197 #undef P2PADVERT_MAX
2201 getifmtu(int ifindex)
2203 int mib[6];
2204 char *buf;
2205 size_t msize;
2206 struct if_msghdr *ifm;
2207 int mtu;
2209 mib[0] = CTL_NET;
2210 mib[1] = PF_ROUTE;
2211 mib[2] = 0;
2212 mib[3] = AF_INET6;
2213 mib[4] = NET_RT_IFLIST;
2214 mib[5] = ifindex;
2215 if (sysctl(mib, 6, NULL, &msize, NULL, 0) < 0) {
2216 fatal("sysctl estimate NET_RT_IFLIST");
2217 /*NOTREACHED*/
2219 if ((buf = malloc(msize)) == NULL) {
2220 fatal("malloc");
2221 /*NOTREACHED*/
2223 if (sysctl(mib, 6, buf, &msize, NULL, 0) < 0) {
2224 fatal("sysctl NET_RT_IFLIST");
2225 /*NOTREACHED*/
2227 ifm = (struct if_msghdr *)buf;
2228 mtu = ifm->ifm_data.ifi_mtu;
2229 #ifdef __DragonFly__
2230 if (ifindex != ifm->ifm_index) {
2231 fatal("ifindex does not match with ifm_index");
2232 /*NOTREACHED*/
2234 #endif
2235 free(buf);
2236 return mtu;
2239 const char *
2240 rttypes(struct rt_msghdr *rtm)
2242 #define RTTYPE(s, f) \
2243 do { \
2244 if (rtm->rtm_type == (f)) \
2245 return (s); \
2246 } while (0)
2247 RTTYPE("ADD", RTM_ADD);
2248 RTTYPE("DELETE", RTM_DELETE);
2249 RTTYPE("CHANGE", RTM_CHANGE);
2250 RTTYPE("GET", RTM_GET);
2251 RTTYPE("LOSING", RTM_LOSING);
2252 RTTYPE("REDIRECT", RTM_REDIRECT);
2253 RTTYPE("MISS", RTM_MISS);
2254 RTTYPE("LOCK", RTM_LOCK);
2255 RTTYPE("OLDADD", RTM_OLDADD);
2256 RTTYPE("OLDDEL", RTM_OLDDEL);
2257 RTTYPE("RESOLVE", RTM_RESOLVE);
2258 RTTYPE("NEWADDR", RTM_NEWADDR);
2259 RTTYPE("DELADDR", RTM_DELADDR);
2260 RTTYPE("IFINFO", RTM_IFINFO);
2261 #ifdef RTM_OLDADD
2262 RTTYPE("OLDADD", RTM_OLDADD);
2263 #endif
2264 #ifdef RTM_OLDDEL
2265 RTTYPE("OLDDEL", RTM_OLDDEL);
2266 #endif
2267 #ifdef RTM_OIFINFO
2268 RTTYPE("OIFINFO", RTM_OIFINFO);
2269 #endif
2270 #ifdef RTM_IFANNOUNCE
2271 RTTYPE("IFANNOUNCE", RTM_IFANNOUNCE);
2272 #endif
2273 #ifdef RTM_NEWMADDR
2274 RTTYPE("NEWMADDR", RTM_NEWMADDR);
2275 #endif
2276 #ifdef RTM_DELMADDR
2277 RTTYPE("DELMADDR", RTM_DELMADDR);
2278 #endif
2279 #undef RTTYPE
2280 return NULL;
2283 const char *
2284 rtflags(struct rt_msghdr *rtm)
2286 static char buf[BUFSIZ];
2289 * letter conflict should be okay. painful when *BSD diverges...
2291 strlcpy(buf, "", sizeof(buf));
2292 #define RTFLAG(s, f) \
2293 do { \
2294 if (rtm->rtm_flags & (f)) \
2295 strlcat(buf, (s), sizeof(buf)); \
2296 } while (0)
2297 RTFLAG("U", RTF_UP);
2298 RTFLAG("G", RTF_GATEWAY);
2299 RTFLAG("H", RTF_HOST);
2300 RTFLAG("R", RTF_REJECT);
2301 RTFLAG("D", RTF_DYNAMIC);
2302 RTFLAG("M", RTF_MODIFIED);
2303 RTFLAG("d", RTF_DONE);
2304 #ifdef RTF_MASK
2305 RTFLAG("m", RTF_MASK);
2306 #endif
2307 RTFLAG("C", RTF_CLONING);
2308 #ifdef RTF_CLONED
2309 RTFLAG("c", RTF_CLONED);
2310 #endif
2311 #ifdef RTF_PRCLONING
2312 RTFLAG("c", RTF_PRCLONING);
2313 #endif
2314 #ifdef RTF_WASCLONED
2315 RTFLAG("W", RTF_WASCLONED);
2316 #endif
2317 RTFLAG("X", RTF_XRESOLVE);
2318 RTFLAG("L", RTF_LLINFO);
2319 RTFLAG("S", RTF_STATIC);
2320 RTFLAG("B", RTF_BLACKHOLE);
2321 #ifdef RTF_PROTO3
2322 RTFLAG("3", RTF_PROTO3);
2323 #endif
2324 RTFLAG("2", RTF_PROTO2);
2325 RTFLAG("1", RTF_PROTO1);
2326 #ifdef RTF_BROADCAST
2327 RTFLAG("b", RTF_BROADCAST);
2328 #endif
2329 #ifdef RTF_DEFAULT
2330 RTFLAG("d", RTF_DEFAULT);
2331 #endif
2332 #ifdef RTF_ISAROUTER
2333 RTFLAG("r", RTF_ISAROUTER);
2334 #endif
2335 #ifdef RTF_TUNNEL
2336 RTFLAG("T", RTF_TUNNEL);
2337 #endif
2338 #ifdef RTF_AUTH
2339 RTFLAG("A", RTF_AUTH);
2340 #endif
2341 #ifdef RTF_CRYPT
2342 RTFLAG("E", RTF_CRYPT);
2343 #endif
2344 #undef RTFLAG
2345 return buf;
2348 const char *
2349 ifflags(int flags)
2351 static char buf[BUFSIZ];
2353 strlcpy(buf, "", sizeof(buf));
2354 #define IFFLAG(s, f) \
2355 do { \
2356 if (flags & f) { \
2357 if (buf[0]) \
2358 strlcat(buf, ",", sizeof(buf)); \
2359 strlcat(buf, s, sizeof(buf)); \
2361 } while (0)
2362 IFFLAG("UP", IFF_UP);
2363 IFFLAG("BROADCAST", IFF_BROADCAST);
2364 IFFLAG("DEBUG", IFF_DEBUG);
2365 IFFLAG("LOOPBACK", IFF_LOOPBACK);
2366 IFFLAG("POINTOPOINT", IFF_POINTOPOINT);
2367 #ifdef IFF_NOTRAILERS
2368 IFFLAG("NOTRAILERS", IFF_NOTRAILERS);
2369 #endif
2370 #ifdef IFF_SMART
2371 IFFLAG("SMART", IFF_SMART);
2372 #endif
2373 IFFLAG("RUNNING", IFF_RUNNING);
2374 IFFLAG("NOARP", IFF_NOARP);
2375 IFFLAG("PROMISC", IFF_PROMISC);
2376 IFFLAG("ALLMULTI", IFF_ALLMULTI);
2377 IFFLAG("OACTIVE", IFF_OACTIVE);
2378 IFFLAG("SIMPLEX", IFF_SIMPLEX);
2379 IFFLAG("LINK0", IFF_LINK0);
2380 IFFLAG("LINK1", IFF_LINK1);
2381 IFFLAG("LINK2", IFF_LINK2);
2382 IFFLAG("MULTICAST", IFF_MULTICAST);
2383 #undef IFFLAG
2384 return buf;
2387 void
2388 krtread(int again)
2390 int mib[6];
2391 size_t msize;
2392 char *buf, *p, *lim;
2393 struct rt_msghdr *rtm;
2394 int retry;
2395 const char *errmsg;
2397 retry = 0;
2398 buf = NULL;
2399 mib[0] = CTL_NET;
2400 mib[1] = PF_ROUTE;
2401 mib[2] = 0;
2402 mib[3] = AF_INET6; /* Address family */
2403 mib[4] = NET_RT_DUMP; /* Dump the kernel routing table */
2404 mib[5] = 0; /* No flags */
2405 do {
2406 retry++;
2407 errmsg = NULL;
2408 if (buf)
2409 free(buf);
2410 if (sysctl(mib, 6, NULL, &msize, NULL, 0) < 0) {
2411 errmsg = "sysctl estimate";
2412 continue;
2414 if ((buf = malloc(msize)) == NULL) {
2415 errmsg = "malloc";
2416 continue;
2418 if (sysctl(mib, 6, buf, &msize, NULL, 0) < 0) {
2419 errmsg = "sysctl NET_RT_DUMP";
2420 continue;
2422 } while (retry < 5 && errmsg != NULL);
2423 if (errmsg) {
2424 fatal("%s (with %d retries, msize=%lu)", errmsg, retry,
2425 (u_long)msize);
2426 /*NOTREACHED*/
2427 } else if (1 < retry)
2428 syslog(LOG_INFO, "NET_RT_DUMP %d retires", retry);
2430 lim = buf + msize;
2431 for (p = buf; p < lim; p += rtm->rtm_msglen) {
2432 rtm = (struct rt_msghdr *)p;
2433 rt_entry(rtm, again);
2435 free(buf);
2438 void
2439 rt_entry(struct rt_msghdr *rtm, int again)
2441 struct sockaddr_in6 *sin6_dst, *sin6_gw, *sin6_mask;
2442 struct sockaddr_in6 *sin6_genmask, *sin6_ifp;
2443 char *rtmp, *ifname = NULL;
2444 struct riprt *rrt, *orrt;
2445 struct netinfo6 *np;
2446 int s;
2448 sin6_dst = sin6_gw = sin6_mask = sin6_genmask = sin6_ifp = 0;
2449 if ((rtm->rtm_flags & RTF_UP) == 0 || rtm->rtm_flags &
2450 (RTF_CLONING|RTF_XRESOLVE|RTF_LLINFO|RTF_BLACKHOLE)) {
2451 return; /* not interested in the link route */
2453 /* do not look at cloned routes */
2454 #ifdef RTF_WASCLONED
2455 if (rtm->rtm_flags & RTF_WASCLONED)
2456 return;
2457 #endif
2458 #ifdef RTF_CLONED
2459 if (rtm->rtm_flags & RTF_CLONED)
2460 return;
2461 #endif
2463 * do not look at dynamic routes.
2464 * netbsd/openbsd cloned routes have UGHD.
2466 if (rtm->rtm_flags & RTF_DYNAMIC)
2467 return;
2468 rtmp = (char *)(rtm + 1);
2469 /* Destination */
2470 if ((rtm->rtm_addrs & RTA_DST) == 0)
2471 return; /* ignore routes without destination address */
2472 sin6_dst = (struct sockaddr_in6 *)rtmp;
2473 rtmp += ROUNDUP(sin6_dst->sin6_len);
2474 if (rtm->rtm_addrs & RTA_GATEWAY) {
2475 sin6_gw = (struct sockaddr_in6 *)rtmp;
2476 rtmp += ROUNDUP(sin6_gw->sin6_len);
2478 if (rtm->rtm_addrs & RTA_NETMASK) {
2479 sin6_mask = (struct sockaddr_in6 *)rtmp;
2480 rtmp += ROUNDUP(sin6_mask->sin6_len);
2482 if (rtm->rtm_addrs & RTA_GENMASK) {
2483 sin6_genmask = (struct sockaddr_in6 *)rtmp;
2484 rtmp += ROUNDUP(sin6_genmask->sin6_len);
2486 if (rtm->rtm_addrs & RTA_IFP) {
2487 sin6_ifp = (struct sockaddr_in6 *)rtmp;
2488 rtmp += ROUNDUP(sin6_ifp->sin6_len);
2491 /* Destination */
2492 if (sin6_dst->sin6_family != AF_INET6)
2493 return;
2494 if (IN6_IS_ADDR_LINKLOCAL(&sin6_dst->sin6_addr))
2495 return; /* Link-local */
2496 if (IN6_ARE_ADDR_EQUAL(&sin6_dst->sin6_addr, &in6addr_loopback))
2497 return; /* Loopback */
2498 if (IN6_IS_ADDR_MULTICAST(&sin6_dst->sin6_addr))
2499 return;
2501 if ((rrt = MALLOC(struct riprt)) == NULL) {
2502 fatal("malloc: struct riprt");
2503 /*NOTREACHED*/
2505 memset(rrt, 0, sizeof(*rrt));
2506 np = &rrt->rrt_info;
2507 rrt->rrt_same = NULL;
2508 rrt->rrt_t = time(NULL);
2509 if (aflag == 0 && (rtm->rtm_flags & RTF_STATIC))
2510 rrt->rrt_t = 0; /* Don't age static routes */
2511 #if 0
2512 np->rip6_tag = htons(routetag & 0xffff);
2513 #else
2514 np->rip6_tag = 0;
2515 #endif
2516 np->rip6_metric = rtm->rtm_rmx.rmx_hopcount;
2517 if (np->rip6_metric < 1)
2518 np->rip6_metric = 1;
2519 rrt->rrt_flags = rtm->rtm_flags;
2520 np->rip6_dest = sin6_dst->sin6_addr;
2522 /* Mask or plen */
2523 if (rtm->rtm_flags & RTF_HOST)
2524 np->rip6_plen = 128; /* Host route */
2525 else if (sin6_mask)
2526 np->rip6_plen = sin6mask2len(sin6_mask);
2527 else
2528 np->rip6_plen = 0;
2530 orrt = rtsearch(np, NULL);
2531 if (orrt && orrt->rrt_info.rip6_metric != HOPCNT_INFINITY6) {
2532 /* Already found */
2533 if (!again) {
2534 trace(1, "route: %s/%d flags %s: already registered\n",
2535 inet6_n2p(&np->rip6_dest), np->rip6_plen,
2536 rtflags(rtm));
2538 free(rrt);
2539 return;
2541 /* Gateway */
2542 if (!sin6_gw)
2543 memset(&rrt->rrt_gw, 0, sizeof(struct in6_addr));
2544 else {
2545 if (sin6_gw->sin6_family == AF_INET6)
2546 rrt->rrt_gw = sin6_gw->sin6_addr;
2547 else if (sin6_gw->sin6_family == AF_LINK) {
2548 /* XXX in case ppp link? */
2549 rrt->rrt_gw = in6addr_loopback;
2550 } else
2551 memset(&rrt->rrt_gw, 0, sizeof(struct in6_addr));
2553 trace(1, "route: %s/%d flags %s",
2554 inet6_n2p(&np->rip6_dest), np->rip6_plen, rtflags(rtm));
2555 trace(1, " gw %s", inet6_n2p(&rrt->rrt_gw));
2557 /* Interface */
2558 s = rtm->rtm_index;
2559 if (s < nindex2ifc && index2ifc[s])
2560 ifname = index2ifc[s]->ifc_name;
2561 else {
2562 trace(1, " not configured\n");
2563 free(rrt);
2564 return;
2566 trace(1, " if %s sock %d", ifname, s);
2567 rrt->rrt_index = s;
2569 trace(1, "\n");
2571 /* Check gateway */
2572 if (!IN6_IS_ADDR_LINKLOCAL(&rrt->rrt_gw) &&
2573 !IN6_IS_ADDR_LOOPBACK(&rrt->rrt_gw)
2574 #ifdef __DragonFly__
2575 && (rrt->rrt_flags & RTF_LOCAL) == 0
2576 #endif
2578 trace(0, "***** Gateway %s is not a link-local address.\n",
2579 inet6_n2p(&rrt->rrt_gw));
2580 trace(0, "***** dest(%s) if(%s) -- Not optimized.\n",
2581 inet6_n2p(&rrt->rrt_info.rip6_dest), ifname);
2582 rrt->rrt_rflags |= RRTF_NH_NOT_LLADDR;
2585 /* Put it to the route list */
2586 if (orrt && orrt->rrt_info.rip6_metric == HOPCNT_INFINITY6) {
2587 /* replace route list */
2588 rrt->rrt_next = orrt->rrt_next;
2589 *orrt = *rrt;
2590 trace(1, "route: %s/%d flags %s: replace new route\n",
2591 inet6_n2p(&np->rip6_dest), np->rip6_plen,
2592 rtflags(rtm));
2593 free(rrt);
2594 } else {
2595 rrt->rrt_next = riprt;
2596 riprt = rrt;
2601 addroute(struct riprt *rrt, const struct in6_addr *gw, struct ifc *ifcp)
2603 struct netinfo6 *np;
2604 u_char buf[BUFSIZ], buf1[BUFSIZ], buf2[BUFSIZ];
2605 struct rt_msghdr *rtm;
2606 struct sockaddr_in6 *sin;
2607 int len;
2609 np = &rrt->rrt_info;
2610 inet_ntop(AF_INET6, (const void *)gw, (char *)buf1, sizeof(buf1));
2611 inet_ntop(AF_INET6, (void *)&ifcp->ifc_mylladdr, (char *)buf2, sizeof(buf2));
2612 tracet(1, "ADD: %s/%d gw %s [%d] ifa %s\n",
2613 inet6_n2p(&np->rip6_dest), np->rip6_plen, buf1,
2614 np->rip6_metric - 1, buf2);
2615 if (rtlog)
2616 fprintf(rtlog, "%s: ADD: %s/%d gw %s [%d] ifa %s\n", hms(),
2617 inet6_n2p(&np->rip6_dest), np->rip6_plen, buf1,
2618 np->rip6_metric - 1, buf2);
2619 if (nflag)
2620 return 0;
2622 memset(buf, 0, sizeof(buf));
2623 rtm = (struct rt_msghdr *)buf;
2624 rtm->rtm_type = RTM_ADD;
2625 rtm->rtm_version = RTM_VERSION;
2626 rtm->rtm_seq = ++seq;
2627 rtm->rtm_pid = pid;
2628 rtm->rtm_flags = rrt->rrt_flags;
2629 rtm->rtm_addrs = RTA_DST | RTA_GATEWAY | RTA_NETMASK;
2630 rtm->rtm_rmx.rmx_hopcount = np->rip6_metric - 1;
2631 rtm->rtm_inits = RTV_HOPCOUNT;
2632 sin = (struct sockaddr_in6 *)&buf[sizeof(struct rt_msghdr)];
2633 /* Destination */
2634 sin->sin6_len = sizeof(struct sockaddr_in6);
2635 sin->sin6_family = AF_INET6;
2636 sin->sin6_addr = np->rip6_dest;
2637 sin = (struct sockaddr_in6 *)((char *)sin + ROUNDUP(sin->sin6_len));
2638 /* Gateway */
2639 sin->sin6_len = sizeof(struct sockaddr_in6);
2640 sin->sin6_family = AF_INET6;
2641 sin->sin6_addr = *gw;
2642 sin = (struct sockaddr_in6 *)((char *)sin + ROUNDUP(sin->sin6_len));
2643 /* Netmask */
2644 sin->sin6_len = sizeof(struct sockaddr_in6);
2645 sin->sin6_family = AF_INET6;
2646 sin->sin6_addr = *(plen2mask(np->rip6_plen));
2647 sin = (struct sockaddr_in6 *)((char *)sin + ROUNDUP(sin->sin6_len));
2649 len = (char *)sin - (char *)buf;
2650 rtm->rtm_msglen = len;
2651 if (write(rtsock, buf, len) > 0)
2652 return 0;
2654 if (errno == EEXIST) {
2655 trace(0, "ADD: Route already exists %s/%d gw %s\n",
2656 inet6_n2p(&np->rip6_dest), np->rip6_plen, buf1);
2657 if (rtlog)
2658 fprintf(rtlog, "ADD: Route already exists %s/%d gw %s\n",
2659 inet6_n2p(&np->rip6_dest), np->rip6_plen, buf1);
2660 } else {
2661 trace(0, "Can not write to rtsock (addroute): %s\n",
2662 strerror(errno));
2663 if (rtlog)
2664 fprintf(rtlog, "\tCan not write to rtsock: %s\n",
2665 strerror(errno));
2667 return -1;
2671 delroute(struct netinfo6 *np, struct in6_addr *gw)
2673 u_char buf[BUFSIZ], buf2[BUFSIZ];
2674 struct rt_msghdr *rtm;
2675 struct sockaddr_in6 *sin;
2676 int len;
2678 inet_ntop(AF_INET6, (void *)gw, (char *)buf2, sizeof(buf2));
2679 tracet(1, "DEL: %s/%d gw %s\n", inet6_n2p(&np->rip6_dest),
2680 np->rip6_plen, buf2);
2681 if (rtlog)
2682 fprintf(rtlog, "%s: DEL: %s/%d gw %s\n",
2683 hms(), inet6_n2p(&np->rip6_dest), np->rip6_plen, buf2);
2684 if (nflag)
2685 return 0;
2687 memset(buf, 0, sizeof(buf));
2688 rtm = (struct rt_msghdr *)buf;
2689 rtm->rtm_type = RTM_DELETE;
2690 rtm->rtm_version = RTM_VERSION;
2691 rtm->rtm_seq = ++seq;
2692 rtm->rtm_pid = pid;
2693 rtm->rtm_flags = RTF_UP | RTF_GATEWAY;
2694 if (np->rip6_plen == sizeof(struct in6_addr) * 8)
2695 rtm->rtm_flags |= RTF_HOST;
2696 rtm->rtm_addrs = RTA_DST | RTA_GATEWAY | RTA_NETMASK;
2697 sin = (struct sockaddr_in6 *)&buf[sizeof(struct rt_msghdr)];
2698 /* Destination */
2699 sin->sin6_len = sizeof(struct sockaddr_in6);
2700 sin->sin6_family = AF_INET6;
2701 sin->sin6_addr = np->rip6_dest;
2702 sin = (struct sockaddr_in6 *)((char *)sin + ROUNDUP(sin->sin6_len));
2703 /* Gateway */
2704 sin->sin6_len = sizeof(struct sockaddr_in6);
2705 sin->sin6_family = AF_INET6;
2706 sin->sin6_addr = *gw;
2707 sin = (struct sockaddr_in6 *)((char *)sin + ROUNDUP(sin->sin6_len));
2708 /* Netmask */
2709 sin->sin6_len = sizeof(struct sockaddr_in6);
2710 sin->sin6_family = AF_INET6;
2711 sin->sin6_addr = *(plen2mask(np->rip6_plen));
2712 sin = (struct sockaddr_in6 *)((char *)sin + ROUNDUP(sin->sin6_len));
2714 len = (char *)sin - (char *)buf;
2715 rtm->rtm_msglen = len;
2716 if (write(rtsock, buf, len) >= 0)
2717 return 0;
2719 if (errno == ESRCH) {
2720 trace(0, "RTDEL: Route does not exist: %s/%d gw %s\n",
2721 inet6_n2p(&np->rip6_dest), np->rip6_plen, buf2);
2722 if (rtlog)
2723 fprintf(rtlog, "RTDEL: Route does not exist: %s/%d gw %s\n",
2724 inet6_n2p(&np->rip6_dest), np->rip6_plen, buf2);
2725 } else {
2726 trace(0, "Can not write to rtsock (delroute): %s\n",
2727 strerror(errno));
2728 if (rtlog)
2729 fprintf(rtlog, "\tCan not write to rtsock: %s\n",
2730 strerror(errno));
2732 return -1;
2735 struct in6_addr *
2736 getroute(struct netinfo6 *np, struct in6_addr *gw)
2738 u_char buf[BUFSIZ];
2739 u_long myseq;
2740 int len;
2741 struct rt_msghdr *rtm;
2742 struct sockaddr_in6 *sin;
2744 rtm = (struct rt_msghdr *)buf;
2745 len = sizeof(struct rt_msghdr) + sizeof(struct sockaddr_in6);
2746 memset(rtm, 0, len);
2747 rtm->rtm_type = RTM_GET;
2748 rtm->rtm_version = RTM_VERSION;
2749 myseq = ++seq;
2750 rtm->rtm_seq = myseq;
2751 rtm->rtm_addrs = RTA_DST;
2752 rtm->rtm_msglen = len;
2753 sin = (struct sockaddr_in6 *)&buf[sizeof(struct rt_msghdr)];
2754 sin->sin6_len = sizeof(struct sockaddr_in6);
2755 sin->sin6_family = AF_INET6;
2756 sin->sin6_addr = np->rip6_dest;
2757 if (write(rtsock, buf, len) < 0) {
2758 if (errno == ESRCH) /* No such route found */
2759 return NULL;
2760 perror("write to rtsock");
2761 exit(1);
2763 do {
2764 if ((len = read(rtsock, buf, sizeof(buf))) < 0) {
2765 perror("read from rtsock");
2766 exit(1);
2768 rtm = (struct rt_msghdr *)buf;
2769 } while (rtm->rtm_seq != myseq || rtm->rtm_pid != pid);
2770 sin = (struct sockaddr_in6 *)&buf[sizeof(struct rt_msghdr)];
2771 if (rtm->rtm_addrs & RTA_DST) {
2772 sin = (struct sockaddr_in6 *)
2773 ((char *)sin + ROUNDUP(sin->sin6_len));
2775 if (rtm->rtm_addrs & RTA_GATEWAY) {
2776 *gw = sin->sin6_addr;
2777 return gw;
2779 return NULL;
2782 const char *
2783 inet6_n2p(const struct in6_addr *p)
2785 static char buf[BUFSIZ];
2787 return inet_ntop(AF_INET6, (const void *)p, buf, sizeof(buf));
2790 void
2791 ifrtdump(int sig)
2793 ifdump(sig);
2794 rtdump(sig);
2797 void
2798 ifdump(int sig)
2800 struct ifc *ifcp;
2801 FILE *dump;
2802 int i;
2804 if (sig == 0)
2805 dump = stderr;
2806 else
2807 if ((dump = fopen(ROUTE6D_DUMP, "a")) == NULL)
2808 dump = stderr;
2810 fprintf(dump, "%s: Interface Table Dump\n", hms());
2811 fprintf(dump, " Number of interfaces: %d\n", nifc);
2812 for (i = 0; i < 2; i++) {
2813 fprintf(dump, " %sadvertising interfaces:\n", i ? "non-" : "");
2814 for (ifcp = ifc; ifcp; ifcp = ifcp->ifc_next) {
2815 if (i == 0) {
2816 if ((ifcp->ifc_flags & IFF_UP) == 0)
2817 continue;
2818 if (iff_find(ifcp, 'N') != NULL)
2819 continue;
2820 } else {
2821 if (ifcp->ifc_flags & IFF_UP)
2822 continue;
2824 ifdump0(dump, ifcp);
2827 fprintf(dump, "\n");
2828 if (dump != stderr)
2829 fclose(dump);
2832 void
2833 ifdump0(FILE *dump, const struct ifc *ifcp)
2835 struct ifac *ifa;
2836 struct iff *iffp;
2837 char buf[BUFSIZ];
2838 const char *ft;
2839 int addr;
2841 fprintf(dump, " %s: index(%d) flags(%s) addr(%s) mtu(%d) metric(%d)\n",
2842 ifcp->ifc_name, ifcp->ifc_index, ifflags(ifcp->ifc_flags),
2843 inet6_n2p(&ifcp->ifc_mylladdr),
2844 ifcp->ifc_mtu, ifcp->ifc_metric);
2845 for (ifa = ifcp->ifc_addr; ifa; ifa = ifa->ifa_next) {
2846 if (ifcp->ifc_flags & IFF_POINTOPOINT) {
2847 inet_ntop(AF_INET6, (void *)&ifa->ifa_raddr,
2848 buf, sizeof(buf));
2849 fprintf(dump, "\t%s/%d -- %s\n",
2850 inet6_n2p(&ifa->ifa_addr),
2851 ifa->ifa_plen, buf);
2852 } else {
2853 fprintf(dump, "\t%s/%d\n",
2854 inet6_n2p(&ifa->ifa_addr),
2855 ifa->ifa_plen);
2858 if (ifcp->ifc_filter) {
2859 fprintf(dump, "\tFilter:");
2860 for (iffp = ifcp->ifc_filter; iffp; iffp = iffp->iff_next) {
2861 addr = 0;
2862 switch (iffp->iff_type) {
2863 case 'A':
2864 ft = "Aggregate"; addr++; break;
2865 case 'N':
2866 ft = "No-use"; break;
2867 case 'O':
2868 ft = "Advertise-only"; addr++; break;
2869 case 'T':
2870 ft = "Default-only"; break;
2871 case 'L':
2872 ft = "Listen-only"; addr++; break;
2873 default:
2874 snprintf(buf, sizeof(buf), "Unknown-%c", iffp->iff_type);
2875 ft = buf;
2876 addr++;
2877 break;
2879 fprintf(dump, " %s", ft);
2880 if (addr) {
2881 fprintf(dump, "(%s/%d)", inet6_n2p(&iffp->iff_addr),
2882 iffp->iff_plen);
2885 fprintf(dump, "\n");
2889 void
2890 rtdump(int sig)
2892 struct riprt *rrt;
2893 char buf[BUFSIZ];
2894 FILE *dump;
2895 time_t t, age;
2897 if (sig == 0)
2898 dump = stderr;
2899 else
2900 if ((dump = fopen(ROUTE6D_DUMP, "a")) == NULL)
2901 dump = stderr;
2903 t = time(NULL);
2904 fprintf(dump, "\n%s: Routing Table Dump\n", hms());
2905 for (rrt = riprt; rrt; rrt = rrt->rrt_next) {
2906 if (rrt->rrt_t == 0)
2907 age = 0;
2908 else
2909 age = t - rrt->rrt_t;
2910 inet_ntop(AF_INET6, (void *)&rrt->rrt_info.rip6_dest,
2911 buf, sizeof(buf));
2912 fprintf(dump, " %s/%d if(%d:%s) gw(%s) [%d] age(%ld)",
2913 buf, rrt->rrt_info.rip6_plen, rrt->rrt_index,
2914 index2ifc[rrt->rrt_index]->ifc_name,
2915 inet6_n2p(&rrt->rrt_gw),
2916 rrt->rrt_info.rip6_metric, (long)age);
2917 if (rrt->rrt_info.rip6_tag) {
2918 fprintf(dump, " tag(0x%04x)",
2919 ntohs(rrt->rrt_info.rip6_tag) & 0xffff);
2921 if (rrt->rrt_rflags & RRTF_NH_NOT_LLADDR)
2922 fprintf(dump, " NOT-LL");
2923 if (rrt->rrt_rflags & RRTF_NOADVERTISE)
2924 fprintf(dump, " NO-ADV");
2925 fprintf(dump, "\n");
2927 fprintf(dump, "\n");
2928 if (dump != stderr)
2929 fclose(dump);
2933 * Parse the -A (and -O) options and put corresponding filter object to the
2934 * specified interface structures. Each of the -A/O option has the following
2935 * syntax: -A 5f09:c400::/32,ef0,ef1 (aggregate)
2936 * -O 5f09:c400::/32,ef0,ef1 (only when match)
2938 void
2939 filterconfig(void)
2941 int i;
2942 char *p, *ap, *iflp, *ifname;
2943 struct iff ftmp, *iff_obj;
2944 struct ifc *ifcp;
2945 struct riprt *rrt;
2946 #if 0
2947 struct in6_addr gw;
2948 #endif
2950 for (i = 0; i < nfilter; i++) {
2951 ap = filter[i];
2952 iflp = NULL;
2953 ifcp = NULL;
2954 if (filtertype[i] == 'N' || filtertype[i] == 'T') {
2955 iflp = ap;
2956 goto ifonly;
2958 if ((p = strchr(ap, ',')) != NULL) {
2959 *p++ = '\0';
2960 iflp = p;
2962 if ((p = strchr(ap, '/')) == NULL) {
2963 fatal("no prefixlen specified for '%s'", ap);
2964 /*NOTREACHED*/
2966 *p++ = '\0';
2967 if (inet_pton(AF_INET6, ap, &ftmp.iff_addr) != 1) {
2968 fatal("invalid prefix specified for '%s'", ap);
2969 /*NOTREACHED*/
2971 ftmp.iff_plen = atoi(p);
2972 ftmp.iff_next = NULL;
2973 applyplen(&ftmp.iff_addr, ftmp.iff_plen);
2974 ifonly:
2975 ftmp.iff_type = filtertype[i];
2976 if (iflp == NULL || *iflp == '\0') {
2977 fatal("no interface specified for '%s'", ap);
2978 /*NOTREACHED*/
2980 /* parse the interface listing portion */
2981 while (iflp) {
2982 ifname = iflp;
2983 if ((iflp = strchr(iflp, ',')) != NULL)
2984 *iflp++ = '\0';
2985 ifcp = ifc_find(ifname);
2986 if (ifcp == NULL) {
2987 fatal("no interface %s exists", ifname);
2988 /*NOTREACHED*/
2990 iff_obj = (struct iff *)malloc(sizeof(struct iff));
2991 if (iff_obj == NULL) {
2992 fatal("malloc of iff_obj");
2993 /*NOTREACHED*/
2995 memcpy((void *)iff_obj, (void *)&ftmp,
2996 sizeof(struct iff));
2997 /* link it to the interface filter */
2998 iff_obj->iff_next = ifcp->ifc_filter;
2999 ifcp->ifc_filter = iff_obj;
3003 * -A: aggregate configuration.
3005 if (filtertype[i] != 'A')
3006 continue;
3007 /* put the aggregate to the kernel routing table */
3008 rrt = (struct riprt *)malloc(sizeof(struct riprt));
3009 if (rrt == NULL) {
3010 fatal("malloc: rrt");
3011 /*NOTREACHED*/
3013 memset(rrt, 0, sizeof(struct riprt));
3014 rrt->rrt_info.rip6_dest = ftmp.iff_addr;
3015 rrt->rrt_info.rip6_plen = ftmp.iff_plen;
3016 rrt->rrt_info.rip6_metric = 1;
3017 rrt->rrt_info.rip6_tag = htons(routetag & 0xffff);
3018 rrt->rrt_gw = in6addr_loopback;
3019 rrt->rrt_flags = RTF_UP | RTF_REJECT;
3020 rrt->rrt_rflags = RRTF_AGGREGATE;
3021 rrt->rrt_t = 0;
3022 rrt->rrt_index = loopifindex;
3023 #if 0
3024 if (getroute(&rrt->rrt_info, &gw)) {
3025 #if 0
3027 * When the address has already been registered in the
3028 * kernel routing table, it should be removed
3030 delroute(&rrt->rrt_info, &gw);
3031 #else
3032 /* it is safer behavior */
3033 errno = EINVAL;
3034 fatal("%s/%u already in routing table, "
3035 "cannot aggregate",
3036 inet6_n2p(&rrt->rrt_info.rip6_dest),
3037 rrt->rrt_info.rip6_plen);
3038 /*NOTREACHED*/
3039 #endif
3041 #endif
3042 /* Put the route to the list */
3043 rrt->rrt_next = riprt;
3044 riprt = rrt;
3045 trace(1, "Aggregate: %s/%d for %s\n",
3046 inet6_n2p(&ftmp.iff_addr), ftmp.iff_plen,
3047 ifcp->ifc_name);
3048 /* Add this route to the kernel */
3049 if (nflag) /* do not modify kernel routing table */
3050 continue;
3051 addroute(rrt, &in6addr_loopback, loopifcp);
3055 /***************** utility functions *****************/
3058 * Returns a pointer to ifac whose address and prefix length matches
3059 * with the address and prefix length specified in the arguments.
3061 struct ifac *
3062 ifa_match(const struct ifc *ifcp, const struct in6_addr *ia, int plen)
3064 struct ifac *ifa;
3066 for (ifa = ifcp->ifc_addr; ifa; ifa = ifa->ifa_next) {
3067 if (IN6_ARE_ADDR_EQUAL(&ifa->ifa_addr, ia) &&
3068 ifa->ifa_plen == plen)
3069 break;
3071 return ifa;
3075 * Return a pointer to riprt structure whose address and prefix length
3076 * matches with the address and prefix length found in the argument.
3077 * Note: This is not a rtalloc(). Therefore exact match is necessary.
3079 struct riprt *
3080 rtsearch(struct netinfo6 *np, struct riprt **prev_rrt)
3082 struct riprt *rrt;
3084 if (prev_rrt)
3085 *prev_rrt = NULL;
3086 for (rrt = riprt; rrt; rrt = rrt->rrt_next) {
3087 if (rrt->rrt_info.rip6_plen == np->rip6_plen &&
3088 IN6_ARE_ADDR_EQUAL(&rrt->rrt_info.rip6_dest,
3089 &np->rip6_dest))
3090 return rrt;
3091 if (prev_rrt)
3092 *prev_rrt = rrt;
3094 if (prev_rrt)
3095 *prev_rrt = NULL;
3096 return 0;
3100 sin6mask2len(const struct sockaddr_in6 *sin6)
3102 return mask2len(&sin6->sin6_addr,
3103 sin6->sin6_len - offsetof(struct sockaddr_in6, sin6_addr));
3107 mask2len(const struct in6_addr *addr, int lenlim)
3109 int i = 0, j;
3110 const u_char *p = (const u_char *)addr;
3112 for (j = 0; j < lenlim; j++, p++) {
3113 if (*p != 0xff)
3114 break;
3115 i += 8;
3117 if (j < lenlim) {
3118 switch (*p) {
3119 #define MASKLEN(m, l) case m: do { i += l; break; } while (0)
3120 MASKLEN(0xfe, 7); break;
3121 MASKLEN(0xfc, 6); break;
3122 MASKLEN(0xf8, 5); break;
3123 MASKLEN(0xf0, 4); break;
3124 MASKLEN(0xe0, 3); break;
3125 MASKLEN(0xc0, 2); break;
3126 MASKLEN(0x80, 1); break;
3127 #undef MASKLEN
3130 return i;
3133 void
3134 applymask(struct in6_addr *addr, struct in6_addr *mask)
3136 int i;
3137 u_long *p, *q;
3139 p = (u_long *)addr; q = (u_long *)mask;
3140 for (i = 0; i < 4; i++)
3141 *p++ &= *q++;
3144 static const u_char plent[8] = {
3145 0x00, 0x80, 0xc0, 0xe0, 0xf0, 0xf8, 0xfc, 0xfe
3148 void
3149 applyplen(struct in6_addr *ia, int plen)
3151 u_char *p;
3152 int i;
3154 p = ia->s6_addr;
3155 for (i = 0; i < 16; i++) {
3156 if (plen <= 0)
3157 *p = 0;
3158 else if (plen < 8)
3159 *p &= plent[plen];
3160 p++, plen -= 8;
3164 static const int pl2m[9] = {
3165 0x00, 0x80, 0xc0, 0xe0, 0xf0, 0xf8, 0xfc, 0xfe, 0xff
3168 struct in6_addr *
3169 plen2mask(int n)
3171 static struct in6_addr ia;
3172 u_char *p;
3173 int i;
3175 memset(&ia, 0, sizeof(struct in6_addr));
3176 p = (u_char *)&ia;
3177 for (i = 0; i < 16; i++, p++, n -= 8) {
3178 if (n >= 8) {
3179 *p = 0xff;
3180 continue;
3182 *p = pl2m[n];
3183 break;
3185 return &ia;
3188 char *
3189 allocopy(char *p)
3191 char *q = (char *)malloc(strlen(p) + 1);
3193 strcpy(q, p);
3194 return q;
3197 char *
3198 hms(void)
3200 static char buf[BUFSIZ];
3201 time_t t;
3202 struct tm *tm;
3204 t = time(NULL);
3205 if ((tm = localtime(&t)) == 0) {
3206 fatal("localtime");
3207 /*NOTREACHED*/
3209 snprintf(buf, sizeof(buf), "%02d:%02d:%02d", tm->tm_hour, tm->tm_min,
3210 tm->tm_sec);
3211 return buf;
3214 #define RIPRANDDEV 1.0 /* 30 +- 15, max - min = 30 */
3217 ripinterval(int timer)
3219 double r = rand();
3221 interval = (int)(timer + timer * RIPRANDDEV * (r / RAND_MAX - 0.5));
3222 nextalarm = time(NULL) + interval;
3223 return interval;
3226 time_t
3227 ripsuptrig(void)
3229 time_t t;
3231 double r = rand();
3232 t = (int)(RIP_TRIG_INT6_MIN +
3233 (RIP_TRIG_INT6_MAX - RIP_TRIG_INT6_MIN) * (r / RAND_MAX));
3234 sup_trig_update = time(NULL) + t;
3235 return t;
3238 void
3239 fatal(const char *fmt, ...)
3241 va_list ap;
3242 char buf[1024];
3244 #ifdef __STDC__
3245 va_start(ap, fmt);
3246 #else
3247 va_start(ap);
3248 #endif
3249 vsnprintf(buf, sizeof(buf), fmt, ap);
3250 perror(buf);
3251 syslog(LOG_ERR, "%s: %s", buf, strerror(errno));
3252 rtdexit();
3253 va_end(ap);
3256 void
3257 tracet(int level, const char *fmt, ...)
3259 va_list ap;
3261 #ifdef __STDC__
3262 va_start(ap, fmt);
3263 #else
3264 va_start(ap);
3265 #endif
3266 if (level <= dflag) {
3267 fprintf(stderr, "%s: ", hms());
3268 vfprintf(stderr, fmt, ap);
3270 if (dflag) {
3271 if (level > 0)
3272 vsyslog(LOG_DEBUG, fmt, ap);
3273 else
3274 vsyslog(LOG_WARNING, fmt, ap);
3276 va_end(ap);
3279 void
3280 trace(int level, const char *fmt, ...)
3282 va_list ap;
3284 #ifdef __STDC__
3285 va_start(ap, fmt);
3286 #else
3287 va_start(ap);
3288 #endif
3289 if (level <= dflag)
3290 vfprintf(stderr, fmt, ap);
3291 if (dflag) {
3292 if (level > 0)
3293 vsyslog(LOG_DEBUG, fmt, ap);
3294 else
3295 vsyslog(LOG_WARNING, fmt, ap);
3297 va_end(ap);
3300 unsigned int
3301 if_maxindex(void)
3303 struct if_nameindex *p, *p0;
3304 unsigned int max = 0;
3306 p0 = if_nameindex();
3307 for (p = p0; p && p->if_index && p->if_name; p++) {
3308 if (max < p->if_index)
3309 max = p->if_index;
3311 if_freenameindex(p0);
3312 return max;
3315 struct ifc *
3316 ifc_find(char *name)
3318 struct ifc *ifcp;
3320 for (ifcp = ifc; ifcp; ifcp = ifcp->ifc_next) {
3321 if (strcmp(name, ifcp->ifc_name) == 0)
3322 return ifcp;
3324 return (struct ifc *)NULL;
3327 struct iff *
3328 iff_find(struct ifc *ifcp, int type)
3330 struct iff *iffp;
3332 for (iffp = ifcp->ifc_filter; iffp; iffp = iffp->iff_next) {
3333 if (iffp->iff_type == type)
3334 return iffp;
3336 return NULL;
3339 void
3340 setindex2ifc(int idx, struct ifc *ifcp)
3342 int n;
3343 struct ifc **p;
3345 if (!index2ifc) {
3346 nindex2ifc = 5; /*initial guess*/
3347 index2ifc = (struct ifc **)
3348 malloc(sizeof(*index2ifc) * nindex2ifc);
3349 if (index2ifc == NULL) {
3350 fatal("malloc");
3351 /*NOTREACHED*/
3353 memset(index2ifc, 0, sizeof(*index2ifc) * nindex2ifc);
3355 n = nindex2ifc;
3356 while (nindex2ifc <= idx)
3357 nindex2ifc *= 2;
3358 if (n != nindex2ifc) {
3359 p = (struct ifc **)realloc(index2ifc,
3360 sizeof(*index2ifc) * nindex2ifc);
3361 if (p == NULL) {
3362 fatal("realloc");
3363 /*NOTREACHED*/
3365 memset(p + n, 0, sizeof(*index2ifc) * (nindex2ifc - n));
3366 index2ifc = p;
3368 index2ifc[idx] = ifcp;