Home | History | Annotate | Line # | Download | only in rtadvd
rtadvd.c revision 1.32
      1 /*	$NetBSD: rtadvd.c,v 1.32 2006/08/02 13:44:53 tron Exp $	*/
      2 /*	$KAME: rtadvd.c,v 1.92 2005/10/17 14:40:02 suz Exp $	*/
      3 
      4 /*
      5  * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project.
      6  * All rights reserved.
      7  *
      8  * Redistribution and use in source and binary forms, with or without
      9  * modification, are permitted provided that the following conditions
     10  * are met:
     11  * 1. Redistributions of source code must retain the above copyright
     12  *    notice, this list of conditions and the following disclaimer.
     13  * 2. Redistributions in binary form must reproduce the above copyright
     14  *    notice, this list of conditions and the following disclaimer in the
     15  *    documentation and/or other materials provided with the distribution.
     16  * 3. Neither the name of the project nor the names of its contributors
     17  *    may be used to endorse or promote products derived from this software
     18  *    without specific prior written permission.
     19  *
     20  * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
     21  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     22  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     23  * ARE DISCLAIMED.  IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
     24  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     25  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     26  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     27  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     28  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     29  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     30  * SUCH DAMAGE.
     31  */
     32 
     33 #include <sys/param.h>
     34 #include <sys/socket.h>
     35 #include <sys/uio.h>
     36 #include <sys/time.h>
     37 #include <sys/queue.h>
     38 
     39 #include <net/if.h>
     40 #include <net/route.h>
     41 #include <net/if_dl.h>
     42 #include <netinet/in.h>
     43 #include <netinet/ip6.h>
     44 #include <netinet6/ip6_var.h>
     45 #include <netinet/icmp6.h>
     46 
     47 #include <arpa/inet.h>
     48 
     49 #include <time.h>
     50 #include <unistd.h>
     51 #include <stdio.h>
     52 #include <stdlib.h>
     53 #include <err.h>
     54 #include <errno.h>
     55 #include <string.h>
     56 #include <stdlib.h>
     57 #include <syslog.h>
     58 #include <util.h>
     59 #include <poll.h>
     60 
     61 #include "rtadvd.h"
     62 #include "rrenum.h"
     63 #include "advcap.h"
     64 #include "timer.h"
     65 #include "if.h"
     66 #include "config.h"
     67 #include "dump.h"
     68 
     69 struct msghdr rcvmhdr;
     70 static u_char *rcvcmsgbuf;
     71 static size_t rcvcmsgbuflen;
     72 static u_char *sndcmsgbuf = NULL;
     73 static size_t sndcmsgbuflen;
     74 volatile sig_atomic_t do_dump;
     75 volatile sig_atomic_t do_die;
     76 struct msghdr sndmhdr;
     77 struct iovec rcviov[2];
     78 struct iovec sndiov[2];
     79 struct sockaddr_in6 rcvfrom;
     80 struct sockaddr_in6 sin6_allnodes = {sizeof(sin6_allnodes), AF_INET6};
     81 struct in6_addr in6a_site_allrouters;
     82 static char *dumpfilename = "/var/run/rtadvd.dump"; /* XXX: should be configurable */
     83 static char *mcastif;
     84 int sock;
     85 int rtsock = -1;
     86 int accept_rr = 0;
     87 int dflag = 0, sflag = 0;
     88 
     89 char *conffile = NULL;
     90 
     91 struct rainfo *ralist = NULL;
     92 struct nd_optlist {
     93 	struct nd_optlist *next;
     94 	struct nd_opt_hdr *opt;
     95 };
     96 union nd_opts {
     97 	struct nd_opt_hdr *nd_opt_array[9];
     98 	struct {
     99 		struct nd_opt_hdr *zero;
    100 		struct nd_opt_hdr *src_lladdr;
    101 		struct nd_opt_hdr *tgt_lladdr;
    102 		struct nd_opt_prefix_info *pi;
    103 		struct nd_opt_rd_hdr *rh;
    104 		struct nd_opt_mtu *mtu;
    105 		struct nd_optlist *list;
    106 	} nd_opt_each;
    107 };
    108 #define nd_opts_src_lladdr	nd_opt_each.src_lladdr
    109 #define nd_opts_tgt_lladdr	nd_opt_each.tgt_lladdr
    110 #define nd_opts_pi		nd_opt_each.pi
    111 #define nd_opts_rh		nd_opt_each.rh
    112 #define nd_opts_mtu		nd_opt_each.mtu
    113 #define nd_opts_list		nd_opt_each.list
    114 
    115 #define NDOPT_FLAG_SRCLINKADDR 0x1
    116 #define NDOPT_FLAG_TGTLINKADDR 0x2
    117 #define NDOPT_FLAG_PREFIXINFO 0x4
    118 #define NDOPT_FLAG_RDHDR 0x8
    119 #define NDOPT_FLAG_MTU 0x10
    120 
    121 u_int32_t ndopt_flags[] = {
    122 	0, NDOPT_FLAG_SRCLINKADDR, NDOPT_FLAG_TGTLINKADDR,
    123 	NDOPT_FLAG_PREFIXINFO, NDOPT_FLAG_RDHDR, NDOPT_FLAG_MTU,
    124 };
    125 
    126 int main __P((int, char *[]));
    127 static void set_die __P((int));
    128 static void die __P((void));
    129 static void sock_open __P((void));
    130 static void rtsock_open __P((void));
    131 static void rtadvd_input __P((void));
    132 static void rs_input __P((int, struct nd_router_solicit *,
    133 			  struct in6_pktinfo *, struct sockaddr_in6 *));
    134 static void ra_input __P((int, struct nd_router_advert *,
    135 			  struct in6_pktinfo *, struct sockaddr_in6 *));
    136 static int prefix_check __P((struct nd_opt_prefix_info *, struct rainfo *,
    137 			     struct sockaddr_in6 *));
    138 static int nd6_options __P((struct nd_opt_hdr *, int,
    139 			    union nd_opts *, u_int32_t));
    140 static void free_ndopts __P((union nd_opts *));
    141 static void ra_output __P((struct rainfo *));
    142 static void rtmsg_input __P((void));
    143 static void rtadvd_set_dump_file __P((int));
    144 static void set_short_delay __P((struct rainfo *));
    145 
    146 int
    147 main(argc, argv)
    148 	int argc;
    149 	char *argv[];
    150 {
    151 	struct pollfd set[2];
    152 	struct timeval *timeout;
    153 	int i, ch;
    154 	int fflag = 0, logopt;
    155 
    156 	/* get command line options and arguments */
    157 #define OPTIONS "c:dDfM:Rs"
    158 	while ((ch = getopt(argc, argv, OPTIONS)) != -1) {
    159 #undef OPTIONS
    160 		switch (ch) {
    161 		case 'c':
    162 			conffile = optarg;
    163 			break;
    164 		case 'd':
    165 			dflag = 1;
    166 			break;
    167 		case 'D':
    168 			dflag = 2;
    169 			break;
    170 		case 'f':
    171 			fflag = 1;
    172 			break;
    173 		case 'M':
    174 			mcastif = optarg;
    175 			break;
    176 		case 'R':
    177 			fprintf(stderr, "rtadvd: "
    178 				"the -R option is currently ignored.\n");
    179 			/* accept_rr = 1; */
    180 			/* run anyway... */
    181 			break;
    182 		case 's':
    183 			sflag = 1;
    184 			break;
    185 		}
    186 	}
    187 	argc -= optind;
    188 	argv += optind;
    189 	if (argc == 0) {
    190 		fprintf(stderr,
    191 			"usage: rtadvd [-DdfMRs] [-c configfile] "
    192 			"interface ...\n");
    193 		exit(1);
    194 	}
    195 
    196 	logopt = LOG_NDELAY | LOG_PID;
    197 	if (fflag)
    198 		logopt |= LOG_PERROR;
    199 	openlog("rtadvd", logopt, LOG_DAEMON);
    200 
    201 	/* set log level */
    202 	if (dflag == 0)
    203 		(void)setlogmask(LOG_UPTO(LOG_ERR));
    204 	if (dflag == 1)
    205 		(void)setlogmask(LOG_UPTO(LOG_INFO));
    206 
    207 	/* timer initialization */
    208 	rtadvd_timer_init();
    209 
    210 	/* get iflist block from kernel */
    211 	init_iflist();
    212 
    213 	while (argc--)
    214 		getconfig(*argv++);
    215 
    216 	if (inet_pton(AF_INET6, ALLNODES, &sin6_allnodes.sin6_addr) != 1) {
    217 		fprintf(stderr, "fatal: inet_pton failed\n");
    218 		exit(1);
    219 	}
    220 
    221 	if (!fflag)
    222 		daemon(1, 0);
    223 
    224 	sock_open();
    225 
    226 	/* record the current PID */
    227 	if (pidfile(NULL) < 0) {
    228 		syslog(LOG_ERR,
    229 		    "<%s> failed to open the pid log file, run anyway.",
    230 		    __func__);
    231 	}
    232 
    233 	set[0].fd = sock;
    234 	set[0].events = POLLIN;
    235 	if (sflag == 0) {
    236 		rtsock_open();
    237 		set[1].fd = rtsock;
    238 		set[1].events = POLLIN;
    239 	} else
    240 		set[1].fd = -1;
    241 
    242 	signal(SIGTERM, set_die);
    243 	signal(SIGUSR1, rtadvd_set_dump_file);
    244 
    245 	for (;;) {
    246 		if (do_dump) {	/* SIGUSR1 */
    247 			do_dump = 0;
    248 			rtadvd_dump_file(dumpfilename);
    249 		}
    250 
    251 		if (do_die) {
    252 			die();
    253 			/*NOTREACHED*/
    254 		}
    255 
    256 		/* timer expiration check and reset the timer */
    257 		timeout = rtadvd_check_timer();
    258 
    259 		if (timeout != NULL) {
    260 			syslog(LOG_DEBUG,
    261 			    "<%s> set timer to %ld:%ld. waiting for "
    262 			    "inputs or timeout", __func__,
    263 			    (long int)timeout->tv_sec,
    264 			    (long int)timeout->tv_usec);
    265 		} else {
    266 			syslog(LOG_DEBUG,
    267 			    "<%s> there's no timer. waiting for inputs",
    268 			    __func__);
    269 		}
    270 
    271 		if ((i = poll(set, 2, timeout ? (timeout->tv_sec * 1000 +
    272 		    timeout->tv_usec / 1000) : INFTIM)) < 0) {
    273 			/* EINTR would occur upon SIGUSR1 for status dump */
    274 			if (errno != EINTR)
    275 				syslog(LOG_ERR, "<%s> select: %s",
    276 				    __func__, strerror(errno));
    277 			continue;
    278 		}
    279 		if (i == 0)	/* timeout */
    280 			continue;
    281 		if (rtsock != -1 && set[1].revents & POLLIN)
    282 			rtmsg_input();
    283 		if (set[0].revents & POLLIN)
    284 			rtadvd_input();
    285 	}
    286 	exit(0);		/* NOTREACHED */
    287 }
    288 
    289 static void
    290 rtadvd_set_dump_file(sig)
    291 	int sig;
    292 {
    293 	do_dump = 1;
    294 }
    295 
    296 static void
    297 set_die(sig)
    298 	int sig;
    299 {
    300 	do_die = 1;
    301 }
    302 
    303 static void
    304 die()
    305 {
    306 	struct rainfo *ra;
    307 	int i;
    308 	const int retrans = MAX_FINAL_RTR_ADVERTISEMENTS;
    309 
    310 	if (dflag > 1) {
    311 		syslog(LOG_DEBUG, "<%s> cease to be an advertising router\n",
    312 		    __func__);
    313 	}
    314 
    315 	for (ra = ralist; ra; ra = ra->next) {
    316 		ra->lifetime = 0;
    317 		make_packet(ra);
    318 	}
    319 	for (i = 0; i < retrans; i++) {
    320 		for (ra = ralist; ra; ra = ra->next)
    321 			ra_output(ra);
    322 		sleep(MIN_DELAY_BETWEEN_RAS);
    323 	}
    324 	exit(0);
    325 	/*NOTREACHED*/
    326 }
    327 
    328 static void
    329 rtmsg_input()
    330 {
    331 	int n, type, ifindex = 0, plen;
    332 	size_t len;
    333 	union rt_msghdr_buf {
    334 		struct rt_msghdr	rt_msghdr;
    335 		char			data[2048];
    336 	} buffer;
    337 	char *msg, *next, *lim;
    338 	char ifname[IF_NAMESIZE];
    339 	struct prefix *prefix;
    340 	struct rainfo *rai;
    341 	struct in6_addr *addr;
    342 	char addrbuf[INET6_ADDRSTRLEN];
    343 	int prefixchange = 0;
    344 
    345 	n = read(rtsock, &buffer, sizeof(buffer));
    346 	msg = buffer.data;
    347 	if (dflag > 1) {
    348 		syslog(LOG_DEBUG, "<%s> received a routing message "
    349 		    "(type = %d, len = %d)", __func__, rtmsg_type(msg), n);
    350 	}
    351 	if (n > rtmsg_len(msg)) {
    352 		/*
    353 		 * This usually won't happen for messages received on
    354 		 * a routing socket.
    355 		 */
    356 		if (dflag > 1)
    357 			syslog(LOG_DEBUG,
    358 			    "<%s> received data length is larger than "
    359 			    "1st routing message len. multiple messages? "
    360 			    "read %d bytes, but 1st msg len = %d",
    361 			    __func__, n, rtmsg_len(msg));
    362 #if 0
    363 		/* adjust length */
    364 		n = rtmsg_len(msg);
    365 #endif
    366 	}
    367 
    368 	lim = msg + n;
    369 	for (next = msg; next < lim; next += len) {
    370 		int oldifflags;
    371 
    372 		next = get_next_msg(next, lim, 0, &len,
    373 				    RTADV_TYPE2BITMASK(RTM_ADD) |
    374 				    RTADV_TYPE2BITMASK(RTM_DELETE) |
    375 				    RTADV_TYPE2BITMASK(RTM_NEWADDR) |
    376 				    RTADV_TYPE2BITMASK(RTM_DELADDR) |
    377 				    RTADV_TYPE2BITMASK(RTM_IFINFO));
    378 		if (len == 0)
    379 			break;
    380 		type = rtmsg_type(next);
    381 		switch (type) {
    382 		case RTM_ADD:
    383 		case RTM_DELETE:
    384 			ifindex = get_rtm_ifindex(next);
    385 			break;
    386 		case RTM_NEWADDR:
    387 		case RTM_DELADDR:
    388 			ifindex = get_ifam_ifindex(next);
    389 			break;
    390 		case RTM_IFINFO:
    391 			ifindex = get_ifm_ifindex(next);
    392 			break;
    393 		default:
    394 			/* should not reach here */
    395 			if (dflag > 1) {
    396 				syslog(LOG_DEBUG,
    397 				       "<%s:%d> unknown rtmsg %d on %s",
    398 				       __func__, __LINE__, type,
    399 				       if_indextoname(ifindex, ifname));
    400 			}
    401 			continue;
    402 		}
    403 
    404 		if ((rai = if_indextorainfo(ifindex)) == NULL) {
    405 			if (dflag > 1) {
    406 				syslog(LOG_DEBUG,
    407 				       "<%s> route changed on "
    408 				       "non advertising interface(%s)",
    409 				       __func__,
    410 				       if_indextoname(ifindex, ifname));
    411 			}
    412 			continue;
    413 		}
    414 		oldifflags = iflist[ifindex]->ifm_flags;
    415 
    416 		switch (type) {
    417 		case RTM_ADD:
    418 			/* init ifflags because it may have changed */
    419 			iflist[ifindex]->ifm_flags =
    420 			    if_getflags(ifindex, iflist[ifindex]->ifm_flags);
    421 
    422 			if (sflag)
    423 				break;	/* we aren't interested in prefixes  */
    424 
    425 			addr = get_addr(msg);
    426 			plen = get_prefixlen(msg);
    427 			/* sanity check for plen */
    428 			/* as RFC2373, prefixlen is at least 4 */
    429 			if (plen < 4 || plen > 127) {
    430 				syslog(LOG_INFO, "<%s> new interface route's"
    431 				    "plen %d is invalid for a prefix",
    432 				    __func__, plen);
    433 				break;
    434 			}
    435 			prefix = find_prefix(rai, addr, plen);
    436 			if (prefix) {
    437 				if (prefix->timer) {
    438 					/*
    439 					 * If the prefix has been invalidated,
    440 					 * make it available again.
    441 					 */
    442 					update_prefix(prefix);
    443 					prefixchange = 1;
    444 				} else if (dflag > 1) {
    445 					syslog(LOG_DEBUG,
    446 					    "<%s> new prefix(%s/%d) "
    447 					    "added on %s, "
    448 					    "but it was already in list",
    449 					    __func__,
    450 					    inet_ntop(AF_INET6, addr,
    451 					    (char *)addrbuf, INET6_ADDRSTRLEN),
    452 					    plen, rai->ifname);
    453 				}
    454 				break;
    455 			}
    456 			make_prefix(rai, ifindex, addr, plen);
    457 			prefixchange = 1;
    458 			break;
    459 		case RTM_DELETE:
    460 			/* init ifflags because it may have changed */
    461 			iflist[ifindex]->ifm_flags =
    462 			    if_getflags(ifindex, iflist[ifindex]->ifm_flags);
    463 
    464 			if (sflag)
    465 				break;
    466 
    467 			addr = get_addr(msg);
    468 			plen = get_prefixlen(msg);
    469 			/* sanity check for plen */
    470 			/* as RFC2373, prefixlen is at least 4 */
    471 			if (plen < 4 || plen > 127) {
    472 				syslog(LOG_INFO,
    473 				    "<%s> deleted interface route's "
    474 				    "plen %d is invalid for a prefix",
    475 				    __func__, plen);
    476 				break;
    477 			}
    478 			prefix = find_prefix(rai, addr, plen);
    479 			if (prefix == NULL) {
    480 				if (dflag > 1) {
    481 					syslog(LOG_DEBUG,
    482 					    "<%s> prefix(%s/%d) was "
    483 					    "deleted on %s, "
    484 					    "but it was not in list",
    485 					    __func__,
    486 					    inet_ntop(AF_INET6, addr,
    487 					    (char *)addrbuf, INET6_ADDRSTRLEN),
    488 					    plen, rai->ifname);
    489 				}
    490 				break;
    491 			}
    492 			invalidate_prefix(prefix);
    493 			prefixchange = 1;
    494 			break;
    495 		case RTM_NEWADDR:
    496 		case RTM_DELADDR:
    497 			/* init ifflags because it may have changed */
    498 			iflist[ifindex]->ifm_flags =
    499 			    if_getflags(ifindex, iflist[ifindex]->ifm_flags);
    500 			break;
    501 		case RTM_IFINFO:
    502 			iflist[ifindex]->ifm_flags = get_ifm_flags(next);
    503 			break;
    504 		default:
    505 			/* should not reach here */
    506 			if (dflag > 1) {
    507 				syslog(LOG_DEBUG,
    508 				    "<%s:%d> unknown rtmsg %d on %s",
    509 				    __func__, __LINE__, type,
    510 				    if_indextoname(ifindex, ifname));
    511 			}
    512 			return;
    513 		}
    514 
    515 		/* check if an interface flag is changed */
    516 		if ((oldifflags & IFF_UP) != 0 &&	/* UP to DOWN */
    517 		    (iflist[ifindex]->ifm_flags & IFF_UP) == 0) {
    518 			syslog(LOG_INFO,
    519 			    "<%s> interface %s becomes down. stop timer.",
    520 			    __func__, rai->ifname);
    521 			rtadvd_remove_timer(&rai->timer);
    522 		} else if ((oldifflags & IFF_UP) == 0 && /* DOWN to UP */
    523 			 (iflist[ifindex]->ifm_flags & IFF_UP) != 0) {
    524 			syslog(LOG_INFO,
    525 			    "<%s> interface %s becomes up. restart timer.",
    526 			    __func__, rai->ifname);
    527 
    528 			rai->initcounter = 0; /* reset the counter */
    529 			rai->waiting = 0; /* XXX */
    530 			rai->timer = rtadvd_add_timer(ra_timeout,
    531 			    ra_timer_update, rai, rai);
    532 			ra_timer_update((void *)rai, &rai->timer->tm);
    533 			rtadvd_set_timer(&rai->timer->tm, rai->timer);
    534 		} else if (prefixchange &&
    535 		    iflist[ifindex]->ifm_flags & IFF_UP) {
    536 			/*
    537 			 * An advertised prefix has been added or invalidated.
    538 			 * Will notice the change in a short delay.
    539 			 */
    540 			rai->initcounter = 0;
    541 			set_short_delay(rai);
    542 		}
    543 	}
    544 
    545 	return;
    546 }
    547 
    548 void
    549 rtadvd_input()
    550 {
    551 	int i;
    552 	int *hlimp = NULL;
    553 #ifdef OLDRAWSOCKET
    554 	struct ip6_hdr *ip;
    555 #endif
    556 	struct icmp6_hdr *icp;
    557 	int ifindex = 0;
    558 	struct cmsghdr *cm;
    559 	struct in6_pktinfo *pi = NULL;
    560 	char ntopbuf[INET6_ADDRSTRLEN], ifnamebuf[IFNAMSIZ];
    561 	struct in6_addr dst = in6addr_any;
    562 
    563 	/*
    564 	 * Get message. We reset msg_controllen since the field could
    565 	 * be modified if we had received a message before setting
    566 	 * receive options.
    567 	 */
    568 	rcvmhdr.msg_controllen = rcvcmsgbuflen;
    569 	if ((i = recvmsg(sock, &rcvmhdr, 0)) < 0)
    570 		return;
    571 
    572 	/* extract optional information via Advanced API */
    573 	for (cm = (struct cmsghdr *)CMSG_FIRSTHDR(&rcvmhdr);
    574 	     cm;
    575 	     cm = (struct cmsghdr *)CMSG_NXTHDR(&rcvmhdr, cm)) {
    576 		if (cm->cmsg_level == IPPROTO_IPV6 &&
    577 		    cm->cmsg_type == IPV6_PKTINFO &&
    578 		    cm->cmsg_len == CMSG_LEN(sizeof(struct in6_pktinfo))) {
    579 			pi = (struct in6_pktinfo *)(CMSG_DATA(cm));
    580 			ifindex = pi->ipi6_ifindex;
    581 			dst = pi->ipi6_addr;
    582 		}
    583 		if (cm->cmsg_level == IPPROTO_IPV6 &&
    584 		    cm->cmsg_type == IPV6_HOPLIMIT &&
    585 		    cm->cmsg_len == CMSG_LEN(sizeof(int)))
    586 			hlimp = (int *)CMSG_DATA(cm);
    587 	}
    588 	if (ifindex == 0) {
    589 		syslog(LOG_ERR,
    590 		       "<%s> failed to get receiving interface",
    591 		       __func__);
    592 		return;
    593 	}
    594 	if (hlimp == NULL) {
    595 		syslog(LOG_ERR,
    596 		       "<%s> failed to get receiving hop limit",
    597 		       __func__);
    598 		return;
    599 	}
    600 
    601 	/*
    602 	 * If we happen to receive data on an interface which is now down,
    603 	 * just discard the data.
    604 	 */
    605 	if ((iflist[pi->ipi6_ifindex]->ifm_flags & IFF_UP) == 0) {
    606 		syslog(LOG_INFO,
    607 		       "<%s> received data on a disabled interface (%s)",
    608 		       __func__,
    609 		       if_indextoname(pi->ipi6_ifindex, ifnamebuf));
    610 		return;
    611 	}
    612 
    613 #ifdef OLDRAWSOCKET
    614 	if (i < sizeof(struct ip6_hdr) + sizeof(struct icmp6_hdr)) {
    615 		syslog(LOG_ERR,
    616 		       "<%s> packet size(%d) is too short",
    617 		       __func__, i);
    618 		return;
    619 	}
    620 
    621 	ip = (struct ip6_hdr *)rcvmhdr.msg_iov[0].iov_base;
    622 	icp = (struct icmp6_hdr *)(ip + 1); /* XXX: ext. hdr? */
    623 #else
    624 	if (i < sizeof(struct icmp6_hdr)) {
    625 		syslog(LOG_ERR,
    626 		       "<%s> packet size(%d) is too short",
    627 		       __func__, i);
    628 		return;
    629 	}
    630 
    631 	icp = (struct icmp6_hdr *)rcvmhdr.msg_iov[0].iov_base;
    632 #endif
    633 
    634 	switch (icp->icmp6_type) {
    635 	case ND_ROUTER_SOLICIT:
    636 		/*
    637 		 * Message verification - RFC-2461 6.1.1
    638 		 * XXX: these checks must be done in the kernel as well,
    639 		 *      but we can't completely rely on them.
    640 		 */
    641 		if (*hlimp != 255) {
    642 			syslog(LOG_NOTICE,
    643 			    "<%s> RS with invalid hop limit(%d) "
    644 			    "received from %s on %s",
    645 			    __func__, *hlimp,
    646 			    inet_ntop(AF_INET6, &rcvfrom.sin6_addr, ntopbuf,
    647 			    INET6_ADDRSTRLEN),
    648 			    if_indextoname(pi->ipi6_ifindex, ifnamebuf));
    649 			return;
    650 		}
    651 		if (icp->icmp6_code) {
    652 			syslog(LOG_NOTICE,
    653 			    "<%s> RS with invalid ICMP6 code(%d) "
    654 			    "received from %s on %s",
    655 			    __func__, icp->icmp6_code,
    656 			    inet_ntop(AF_INET6, &rcvfrom.sin6_addr, ntopbuf,
    657 			    INET6_ADDRSTRLEN),
    658 			    if_indextoname(pi->ipi6_ifindex, ifnamebuf));
    659 			return;
    660 		}
    661 		if (i < sizeof(struct nd_router_solicit)) {
    662 			syslog(LOG_NOTICE,
    663 			    "<%s> RS from %s on %s does not have enough "
    664 			    "length (len = %d)",
    665 			    __func__,
    666 			    inet_ntop(AF_INET6, &rcvfrom.sin6_addr, ntopbuf,
    667 			    INET6_ADDRSTRLEN),
    668 			    if_indextoname(pi->ipi6_ifindex, ifnamebuf), i);
    669 			return;
    670 		}
    671 		rs_input(i, (struct nd_router_solicit *)icp, pi, &rcvfrom);
    672 		break;
    673 	case ND_ROUTER_ADVERT:
    674 		/*
    675 		 * Message verification - RFC-2461 6.1.2
    676 		 * XXX: there's a same dilemma as above...
    677 		 */
    678 		if (*hlimp != 255) {
    679 			syslog(LOG_NOTICE,
    680 			    "<%s> RA with invalid hop limit(%d) "
    681 			    "received from %s on %s",
    682 			    __func__, *hlimp,
    683 			    inet_ntop(AF_INET6, &rcvfrom.sin6_addr, ntopbuf,
    684 			    INET6_ADDRSTRLEN),
    685 			    if_indextoname(pi->ipi6_ifindex, ifnamebuf));
    686 			return;
    687 		}
    688 		if (icp->icmp6_code) {
    689 			syslog(LOG_NOTICE,
    690 			    "<%s> RA with invalid ICMP6 code(%d) "
    691 			    "received from %s on %s",
    692 			    __func__, icp->icmp6_code,
    693 			    inet_ntop(AF_INET6, &rcvfrom.sin6_addr, ntopbuf,
    694 			    INET6_ADDRSTRLEN),
    695 			    if_indextoname(pi->ipi6_ifindex, ifnamebuf));
    696 			return;
    697 		}
    698 		if (i < sizeof(struct nd_router_advert)) {
    699 			syslog(LOG_NOTICE,
    700 			    "<%s> RA from %s on %s does not have enough "
    701 			    "length (len = %d)",
    702 			    __func__,
    703 			    inet_ntop(AF_INET6, &rcvfrom.sin6_addr, ntopbuf,
    704 			    INET6_ADDRSTRLEN),
    705 			    if_indextoname(pi->ipi6_ifindex, ifnamebuf), i);
    706 			return;
    707 		}
    708 		ra_input(i, (struct nd_router_advert *)icp, pi, &rcvfrom);
    709 		break;
    710 	case ICMP6_ROUTER_RENUMBERING:
    711 		if (accept_rr == 0) {
    712 			syslog(LOG_ERR, "<%s> received a router renumbering "
    713 			    "message, but not allowed to be accepted",
    714 			    __func__);
    715 			break;
    716 		}
    717 		rr_input(i, (struct icmp6_router_renum *)icp, pi, &rcvfrom,
    718 			 &dst);
    719 		break;
    720 	default:
    721 		/*
    722 		 * Note that this case is POSSIBLE, especially just
    723 		 * after invocation of the daemon. This is because we
    724 		 * could receive message after opening the socket and
    725 		 * before setting ICMP6 type filter(see sock_open()).
    726 		 */
    727 		syslog(LOG_ERR, "<%s> invalid icmp type(%d)",
    728 		    __func__, icp->icmp6_type);
    729 		return;
    730 	}
    731 
    732 	return;
    733 }
    734 
    735 static void
    736 rs_input(int len, struct nd_router_solicit *rs,
    737 	 struct in6_pktinfo *pi, struct sockaddr_in6 *from)
    738 {
    739 	char ntopbuf[INET6_ADDRSTRLEN], ifnamebuf[IFNAMSIZ];
    740 	union nd_opts ndopts;
    741 	struct rainfo *ra;
    742 	struct soliciter *sol;
    743 
    744 	syslog(LOG_DEBUG,
    745 	       "<%s> RS received from %s on %s",
    746 	       __func__,
    747 	       inet_ntop(AF_INET6, &from->sin6_addr,
    748 			 ntopbuf, INET6_ADDRSTRLEN),
    749 	       if_indextoname(pi->ipi6_ifindex, ifnamebuf));
    750 
    751 	/* ND option check */
    752 	memset(&ndopts, 0, sizeof(ndopts));
    753 	if (nd6_options((struct nd_opt_hdr *)(rs + 1),
    754 			len - sizeof(struct nd_router_solicit),
    755 			&ndopts, NDOPT_FLAG_SRCLINKADDR)) {
    756 		syslog(LOG_INFO,
    757 		       "<%s> ND option check failed for an RS from %s on %s",
    758 		       __func__,
    759 		       inet_ntop(AF_INET6, &from->sin6_addr,
    760 				 ntopbuf, INET6_ADDRSTRLEN),
    761 		       if_indextoname(pi->ipi6_ifindex, ifnamebuf));
    762 		return;
    763 	}
    764 
    765 	/*
    766 	 * If the IP source address is the unspecified address, there
    767 	 * must be no source link-layer address option in the message.
    768 	 * (RFC-2461 6.1.1)
    769 	 */
    770 	if (IN6_IS_ADDR_UNSPECIFIED(&from->sin6_addr) &&
    771 	    ndopts.nd_opts_src_lladdr) {
    772 		syslog(LOG_INFO,
    773 		       "<%s> RS from unspecified src on %s has a link-layer"
    774 		       " address option",
    775 		       __func__,
    776 		       if_indextoname(pi->ipi6_ifindex, ifnamebuf));
    777 		goto done;
    778 	}
    779 
    780 	ra = ralist;
    781 	while (ra != NULL) {
    782 		if (pi->ipi6_ifindex == ra->ifindex)
    783 			break;
    784 		ra = ra->next;
    785 	}
    786 	if (ra == NULL) {
    787 		syslog(LOG_INFO,
    788 		       "<%s> RS received on non advertising interface(%s)",
    789 		       __func__,
    790 		       if_indextoname(pi->ipi6_ifindex, ifnamebuf));
    791 		goto done;
    792 	}
    793 
    794 	ra->rsinput++;		/* increment statistics */
    795 
    796 	/*
    797 	 * Decide whether to send RA according to the rate-limit
    798 	 * consideration.
    799 	 */
    800 
    801 	/* record sockaddr waiting for RA, if possible */
    802 	sol = (struct soliciter *)malloc(sizeof(*sol));
    803 	if (sol) {
    804 		sol->addr = *from;
    805 		/* XXX RFC2553 need clarification on flowinfo */
    806 		sol->addr.sin6_flowinfo = 0;
    807 		sol->next = ra->soliciter;
    808 		ra->soliciter = sol;
    809 	}
    810 
    811 	/*
    812 	 * If there is already a waiting RS packet, don't
    813 	 * update the timer.
    814 	 */
    815 	if (ra->waiting++)
    816 		goto done;
    817 
    818 	set_short_delay(ra);
    819 
    820 done:
    821 	free_ndopts(&ndopts);
    822 	return;
    823 }
    824 
    825 static void
    826 set_short_delay(rai)
    827 	struct rainfo *rai;
    828 {
    829 	long delay;	/* must not be greater than 1000000 */
    830 	struct timeval interval, now, min_delay, tm_tmp, *rest;
    831 
    832 	/*
    833 	 * Compute a random delay. If the computed value
    834 	 * corresponds to a time later than the time the next
    835 	 * multicast RA is scheduled to be sent, ignore the random
    836 	 * delay and send the advertisement at the
    837 	 * already-scheduled time. RFC2461 6.2.6
    838 	 */
    839 	delay = arc4random() % MAX_RA_DELAY_TIME;
    840 	interval.tv_sec = 0;
    841 	interval.tv_usec = delay;
    842 	rest = rtadvd_timer_rest(rai->timer);
    843 	if (TIMEVAL_LT(*rest, interval)) {
    844 		syslog(LOG_DEBUG, "<%s> random delay is larger than "
    845 		    "the rest of current timer", __func__);
    846 		interval = *rest;
    847 	}
    848 
    849 	/*
    850 	 * If we sent a multicast Router Advertisement within
    851 	 * the last MIN_DELAY_BETWEEN_RAS seconds, schedule
    852 	 * the advertisement to be sent at a time corresponding to
    853 	 * MIN_DELAY_BETWEEN_RAS plus the random value after the
    854 	 * previous advertisement was sent.
    855 	 */
    856 	gettimeofday(&now, NULL);
    857 	TIMEVAL_SUB(&now, &rai->lastsent, &tm_tmp);
    858 	min_delay.tv_sec = MIN_DELAY_BETWEEN_RAS;
    859 	min_delay.tv_usec = 0;
    860 	if (TIMEVAL_LT(tm_tmp, min_delay)) {
    861 		TIMEVAL_SUB(&min_delay, &tm_tmp, &min_delay);
    862 		TIMEVAL_ADD(&min_delay, &interval, &interval);
    863 	}
    864 	rtadvd_set_timer(&interval, rai->timer);
    865 }
    866 
    867 static void
    868 ra_input(int len, struct nd_router_advert *ra,
    869 	 struct in6_pktinfo *pi, struct sockaddr_in6 *from)
    870 {
    871 	struct rainfo *rai;
    872 	char ntopbuf[INET6_ADDRSTRLEN], ifnamebuf[IFNAMSIZ];
    873 	union nd_opts ndopts;
    874 	char *on_off[] = {"OFF", "ON"};
    875 	u_int32_t reachabletime, retranstimer, mtu;
    876 	int inconsistent = 0;
    877 
    878 	syslog(LOG_DEBUG,
    879 	       "<%s> RA received from %s on %s",
    880 	       __func__,
    881 	       inet_ntop(AF_INET6, &from->sin6_addr,
    882 			 ntopbuf, INET6_ADDRSTRLEN),
    883 	       if_indextoname(pi->ipi6_ifindex, ifnamebuf));
    884 
    885 	/* ND option check */
    886 	memset(&ndopts, 0, sizeof(ndopts));
    887 	if (nd6_options((struct nd_opt_hdr *)(ra + 1),
    888 			len - sizeof(struct nd_router_advert),
    889 			&ndopts, NDOPT_FLAG_SRCLINKADDR |
    890 			NDOPT_FLAG_PREFIXINFO | NDOPT_FLAG_MTU)) {
    891 		syslog(LOG_INFO,
    892 		       "<%s> ND option check failed for an RA from %s on %s",
    893 		       __func__,
    894 		       inet_ntop(AF_INET6, &from->sin6_addr,
    895 				 ntopbuf, INET6_ADDRSTRLEN),
    896 		       if_indextoname(pi->ipi6_ifindex, ifnamebuf));
    897 		return;
    898 	}
    899 
    900 	/*
    901 	 * RA consistency check according to RFC-2461 6.2.7
    902 	 */
    903 	if ((rai = if_indextorainfo(pi->ipi6_ifindex)) == 0) {
    904 		syslog(LOG_INFO,
    905 		       "<%s> received RA from %s on non-advertising"
    906 		       " interface(%s)",
    907 		       __func__,
    908 		       inet_ntop(AF_INET6, &from->sin6_addr,
    909 				 ntopbuf, INET6_ADDRSTRLEN),
    910 		       if_indextoname(pi->ipi6_ifindex, ifnamebuf));
    911 		goto done;
    912 	}
    913 	rai->rainput++;		/* increment statistics */
    914 
    915 	/* Cur Hop Limit value */
    916 	if (ra->nd_ra_curhoplimit && rai->hoplimit &&
    917 	    ra->nd_ra_curhoplimit != rai->hoplimit) {
    918 		syslog(LOG_INFO,
    919 		       "<%s> CurHopLimit inconsistent on %s:"
    920 		       " %d from %s, %d from us",
    921 		       __func__,
    922 		       rai->ifname,
    923 		       ra->nd_ra_curhoplimit,
    924 		       inet_ntop(AF_INET6, &from->sin6_addr,
    925 				 ntopbuf, INET6_ADDRSTRLEN),
    926 		       rai->hoplimit);
    927 		inconsistent++;
    928 	}
    929 	/* M flag */
    930 	if ((ra->nd_ra_flags_reserved & ND_RA_FLAG_MANAGED) !=
    931 	    rai->managedflg) {
    932 		syslog(LOG_INFO,
    933 		       "<%s> M flag inconsistent on %s:"
    934 		       " %s from %s, %s from us",
    935 		       __func__,
    936 		       rai->ifname,
    937 		       on_off[!rai->managedflg],
    938 		       inet_ntop(AF_INET6, &from->sin6_addr,
    939 				 ntopbuf, INET6_ADDRSTRLEN),
    940 		       on_off[rai->managedflg]);
    941 		inconsistent++;
    942 	}
    943 	/* O flag */
    944 	if ((ra->nd_ra_flags_reserved & ND_RA_FLAG_OTHER) !=
    945 	    rai->otherflg) {
    946 		syslog(LOG_INFO,
    947 		       "<%s> O flag inconsistent on %s:"
    948 		       " %s from %s, %s from us",
    949 		       __func__,
    950 		       rai->ifname,
    951 		       on_off[!rai->otherflg],
    952 		       inet_ntop(AF_INET6, &from->sin6_addr,
    953 				 ntopbuf, INET6_ADDRSTRLEN),
    954 		       on_off[rai->otherflg]);
    955 		inconsistent++;
    956 	}
    957 	/* Reachable Time */
    958 	reachabletime = ntohl(ra->nd_ra_reachable);
    959 	if (reachabletime && rai->reachabletime &&
    960 	    reachabletime != rai->reachabletime) {
    961 		syslog(LOG_INFO,
    962 		       "<%s> ReachableTime inconsistent on %s:"
    963 		       " %d from %s, %d from us",
    964 		       __func__,
    965 		       rai->ifname,
    966 		       reachabletime,
    967 		       inet_ntop(AF_INET6, &from->sin6_addr,
    968 				 ntopbuf, INET6_ADDRSTRLEN),
    969 		       rai->reachabletime);
    970 		inconsistent++;
    971 	}
    972 	/* Retrans Timer */
    973 	retranstimer = ntohl(ra->nd_ra_retransmit);
    974 	if (retranstimer && rai->retranstimer &&
    975 	    retranstimer != rai->retranstimer) {
    976 		syslog(LOG_INFO,
    977 		       "<%s> RetranceTimer inconsistent on %s:"
    978 		       " %d from %s, %d from us",
    979 		       __func__,
    980 		       rai->ifname,
    981 		       retranstimer,
    982 		       inet_ntop(AF_INET6, &from->sin6_addr,
    983 				 ntopbuf, INET6_ADDRSTRLEN),
    984 		       rai->retranstimer);
    985 		inconsistent++;
    986 	}
    987 	/* Values in the MTU options */
    988 	if (ndopts.nd_opts_mtu) {
    989 		mtu = ntohl(ndopts.nd_opts_mtu->nd_opt_mtu_mtu);
    990 		if (mtu && rai->linkmtu && mtu != rai->linkmtu) {
    991 			syslog(LOG_INFO,
    992 			       "<%s> MTU option value inconsistent on %s:"
    993 			       " %d from %s, %d from us",
    994 			       __func__,
    995 			       rai->ifname, mtu,
    996 			       inet_ntop(AF_INET6, &from->sin6_addr,
    997 					 ntopbuf, INET6_ADDRSTRLEN),
    998 			       rai->linkmtu);
    999 			inconsistent++;
   1000 		}
   1001 	}
   1002 	/* Preferred and Valid Lifetimes for prefixes */
   1003 	{
   1004 		struct nd_optlist *optp = ndopts.nd_opts_list;
   1005 
   1006 		if (ndopts.nd_opts_pi) {
   1007 			if (prefix_check(ndopts.nd_opts_pi, rai, from))
   1008 				inconsistent++;
   1009 		}
   1010 		while (optp) {
   1011 			if (prefix_check((struct nd_opt_prefix_info *)optp->opt,
   1012 					 rai, from))
   1013 				inconsistent++;
   1014 			optp = optp->next;
   1015 		}
   1016 	}
   1017 
   1018 	if (inconsistent)
   1019 		rai->rainconsistent++;
   1020 
   1021 done:
   1022 	free_ndopts(&ndopts);
   1023 	return;
   1024 }
   1025 
   1026 /* return a non-zero value if the received prefix is inconsitent with ours */
   1027 static int
   1028 prefix_check(struct nd_opt_prefix_info *pinfo,
   1029 	     struct rainfo *rai, struct sockaddr_in6 *from)
   1030 {
   1031 	u_int32_t preferred_time, valid_time;
   1032 	struct prefix *pp;
   1033 	int inconsistent = 0;
   1034 	char ntopbuf[INET6_ADDRSTRLEN], prefixbuf[INET6_ADDRSTRLEN];
   1035 	struct timeval now;
   1036 
   1037 #if 0				/* impossible */
   1038 	if (pinfo->nd_opt_pi_type != ND_OPT_PREFIX_INFORMATION)
   1039 		return(0);
   1040 #endif
   1041 
   1042 	/*
   1043 	 * log if the adveritsed prefix has link-local scope(sanity check?)
   1044 	 */
   1045 	if (IN6_IS_ADDR_LINKLOCAL(&pinfo->nd_opt_pi_prefix)) {
   1046 		syslog(LOG_INFO,
   1047 		       "<%s> link-local prefix %s/%d is advertised "
   1048 		       "from %s on %s",
   1049 		       __func__,
   1050 		       inet_ntop(AF_INET6, &pinfo->nd_opt_pi_prefix,
   1051 				 prefixbuf, INET6_ADDRSTRLEN),
   1052 		       pinfo->nd_opt_pi_prefix_len,
   1053 		       inet_ntop(AF_INET6, &from->sin6_addr,
   1054 				 ntopbuf, INET6_ADDRSTRLEN),
   1055 		       rai->ifname);
   1056 	}
   1057 
   1058 	if ((pp = find_prefix(rai, &pinfo->nd_opt_pi_prefix,
   1059 			      pinfo->nd_opt_pi_prefix_len)) == NULL) {
   1060 		syslog(LOG_INFO,
   1061 		       "<%s> prefix %s/%d from %s on %s is not in our list",
   1062 		       __func__,
   1063 		       inet_ntop(AF_INET6, &pinfo->nd_opt_pi_prefix,
   1064 				 prefixbuf, INET6_ADDRSTRLEN),
   1065 		       pinfo->nd_opt_pi_prefix_len,
   1066 		       inet_ntop(AF_INET6, &from->sin6_addr,
   1067 				 ntopbuf, INET6_ADDRSTRLEN),
   1068 		       rai->ifname);
   1069 		return(0);
   1070 	}
   1071 
   1072 	preferred_time = ntohl(pinfo->nd_opt_pi_preferred_time);
   1073 	if (pp->pltimeexpire) {
   1074 		/*
   1075 		 * The lifetime is decremented in real time, so we should
   1076 		 * compare the expiration time.
   1077 		 * (RFC 2461 Section 6.2.7.)
   1078 		 * XXX: can we really expect that all routers on the link
   1079 		 * have synchronized clocks?
   1080 		 */
   1081 		gettimeofday(&now, NULL);
   1082 		preferred_time += now.tv_sec;
   1083 
   1084 		if (!pp->timer && rai->clockskew &&
   1085 		    abs(preferred_time - pp->pltimeexpire) > rai->clockskew) {
   1086 			syslog(LOG_INFO,
   1087 			       "<%s> preferred lifetime for %s/%d"
   1088 			       " (decr. in real time) inconsistent on %s:"
   1089 			       " %d from %s, %ld from us",
   1090 			       __func__,
   1091 			       inet_ntop(AF_INET6, &pinfo->nd_opt_pi_prefix,
   1092 					 prefixbuf, INET6_ADDRSTRLEN),
   1093 			       pinfo->nd_opt_pi_prefix_len,
   1094 			       rai->ifname, preferred_time,
   1095 			       inet_ntop(AF_INET6, &from->sin6_addr,
   1096 					 ntopbuf, INET6_ADDRSTRLEN),
   1097 			       pp->pltimeexpire);
   1098 			inconsistent++;
   1099 		}
   1100 	} else if (!pp->timer && preferred_time != pp->preflifetime) {
   1101 		syslog(LOG_INFO,
   1102 		       "<%s> preferred lifetime for %s/%d"
   1103 		       " inconsistent on %s:"
   1104 		       " %d from %s, %d from us",
   1105 		       __func__,
   1106 		       inet_ntop(AF_INET6, &pinfo->nd_opt_pi_prefix,
   1107 				 prefixbuf, INET6_ADDRSTRLEN),
   1108 		       pinfo->nd_opt_pi_prefix_len,
   1109 		       rai->ifname, preferred_time,
   1110 		       inet_ntop(AF_INET6, &from->sin6_addr,
   1111 				 ntopbuf, INET6_ADDRSTRLEN),
   1112 		       pp->preflifetime);
   1113 	}
   1114 
   1115 	valid_time = ntohl(pinfo->nd_opt_pi_valid_time);
   1116 	if (pp->vltimeexpire) {
   1117 		gettimeofday(&now, NULL);
   1118 		valid_time += now.tv_sec;
   1119 
   1120 		if (!pp->timer && rai->clockskew &&
   1121 		    abs(valid_time - pp->vltimeexpire) > rai->clockskew) {
   1122 			syslog(LOG_INFO,
   1123 			       "<%s> valid lifetime for %s/%d"
   1124 			       " (decr. in real time) inconsistent on %s:"
   1125 			       " %d from %s, %ld from us",
   1126 			       __func__,
   1127 			       inet_ntop(AF_INET6, &pinfo->nd_opt_pi_prefix,
   1128 					 prefixbuf, INET6_ADDRSTRLEN),
   1129 			       pinfo->nd_opt_pi_prefix_len,
   1130 			       rai->ifname, preferred_time,
   1131 			       inet_ntop(AF_INET6, &from->sin6_addr,
   1132 					 ntopbuf, INET6_ADDRSTRLEN),
   1133 			       pp->vltimeexpire);
   1134 			inconsistent++;
   1135 		}
   1136 	} else if (!pp->timer && valid_time != pp->validlifetime) {
   1137 		syslog(LOG_INFO,
   1138 		       "<%s> valid lifetime for %s/%d"
   1139 		       " inconsistent on %s:"
   1140 		       " %d from %s, %d from us",
   1141 		       __func__,
   1142 		       inet_ntop(AF_INET6, &pinfo->nd_opt_pi_prefix,
   1143 				 prefixbuf, INET6_ADDRSTRLEN),
   1144 		       pinfo->nd_opt_pi_prefix_len,
   1145 		       rai->ifname, valid_time,
   1146 		       inet_ntop(AF_INET6, &from->sin6_addr,
   1147 				 ntopbuf, INET6_ADDRSTRLEN),
   1148 		       pp->validlifetime);
   1149 		inconsistent++;
   1150 	}
   1151 
   1152 	return(inconsistent);
   1153 }
   1154 
   1155 struct prefix *
   1156 find_prefix(struct rainfo *rai, struct in6_addr *prefix, int plen)
   1157 {
   1158 	struct prefix *pp;
   1159 	int bytelen, bitlen;
   1160 	u_char bitmask;
   1161 
   1162 	for (pp = rai->prefix.next; pp != &rai->prefix; pp = pp->next) {
   1163 		if (plen != pp->prefixlen)
   1164 			continue;
   1165 		bytelen = plen / 8;
   1166 		bitlen = plen % 8;
   1167 		bitmask = 0xff << (8 - bitlen);
   1168 		if (memcmp((void *)prefix, (void *)&pp->prefix, bytelen))
   1169 			continue;
   1170 		if (bitlen == 0 ||
   1171 		    ((prefix->s6_addr[bytelen] & bitmask) ==
   1172 		     (pp->prefix.s6_addr[bytelen] & bitmask))) {
   1173 			return(pp);
   1174 		}
   1175 	}
   1176 
   1177 	return(NULL);
   1178 }
   1179 
   1180 /* check if p0/plen0 matches p1/plen1; return 1 if matches, otherwise 0. */
   1181 int
   1182 prefix_match(struct in6_addr *p0, int plen0,
   1183 	     struct in6_addr *p1, int plen1)
   1184 {
   1185 	int bytelen, bitlen;
   1186 	u_char bitmask;
   1187 
   1188 	if (plen0 < plen1)
   1189 		return(0);
   1190 	bytelen = plen1 / 8;
   1191 	bitlen = plen1 % 8;
   1192 	bitmask = 0xff << (8 - bitlen);
   1193 	if (memcmp((void *)p0, (void *)p1, bytelen))
   1194 		return(0);
   1195 	if (bitlen == 0 ||
   1196 	    ((p0->s6_addr[bytelen] & bitmask) ==
   1197 	     (p1->s6_addr[bytelen] & bitmask))) {
   1198 		return(1);
   1199 	}
   1200 
   1201 	return(0);
   1202 }
   1203 
   1204 static int
   1205 nd6_options(struct nd_opt_hdr *hdr, int limit,
   1206 	    union nd_opts *ndopts, u_int32_t optflags)
   1207 {
   1208 	int optlen = 0;
   1209 
   1210 	for (; limit > 0; limit -= optlen) {
   1211 		if (limit < sizeof(struct nd_opt_hdr)) {
   1212 			syslog(LOG_INFO, "<%s> short option header", __func__);
   1213 			goto bad;
   1214 		}
   1215 
   1216 		hdr = (struct nd_opt_hdr *)((caddr_t)hdr + optlen);
   1217 		if (hdr->nd_opt_len == 0) {
   1218 			syslog(LOG_INFO,
   1219 			    "<%s> bad ND option length(0) (type = %d)",
   1220 			    __func__, hdr->nd_opt_type);
   1221 			goto bad;
   1222 		}
   1223 		optlen = hdr->nd_opt_len << 3;
   1224 		if (optlen > limit) {
   1225 			syslog(LOG_INFO, "<%s> short option", __func__);
   1226 			goto bad;
   1227 		}
   1228 
   1229 		if (hdr->nd_opt_type > ND_OPT_MTU)
   1230 		{
   1231 			syslog(LOG_INFO, "<%s> unknown ND option(type %d)",
   1232 			    __func__, hdr->nd_opt_type);
   1233 			continue;
   1234 		}
   1235 
   1236 		if ((ndopt_flags[hdr->nd_opt_type] & optflags) == 0) {
   1237 			syslog(LOG_INFO, "<%s> unexpected ND option(type %d)",
   1238 			    __func__, hdr->nd_opt_type);
   1239 			continue;
   1240 		}
   1241 
   1242 		/*
   1243 		 * Option length check.  Do it here for all fixed-length
   1244 		 * options.
   1245 		 */
   1246 		if ((hdr->nd_opt_type == ND_OPT_MTU &&
   1247 		    (optlen != sizeof(struct nd_opt_mtu))) ||
   1248 		    ((hdr->nd_opt_type == ND_OPT_PREFIX_INFORMATION &&
   1249 		    optlen != sizeof(struct nd_opt_prefix_info)))) {
   1250 			syslog(LOG_INFO, "<%s> invalid option length",
   1251 			    __func__);
   1252 			continue;
   1253 		}
   1254 
   1255 		switch (hdr->nd_opt_type) {
   1256 		case ND_OPT_TARGET_LINKADDR:
   1257 		case ND_OPT_REDIRECTED_HEADER:
   1258 			break;	/* we don't care about these options */
   1259 		case ND_OPT_SOURCE_LINKADDR:
   1260 		case ND_OPT_MTU:
   1261 			if (ndopts->nd_opt_array[hdr->nd_opt_type]) {
   1262 				syslog(LOG_INFO,
   1263 				    "<%s> duplicated ND option (type = %d)",
   1264 				    __func__, hdr->nd_opt_type);
   1265 			}
   1266 			ndopts->nd_opt_array[hdr->nd_opt_type] = hdr;
   1267 			break;
   1268 		case ND_OPT_PREFIX_INFORMATION:
   1269 		{
   1270 			struct nd_optlist *pfxlist;
   1271 
   1272 			if (ndopts->nd_opts_pi == 0) {
   1273 				ndopts->nd_opts_pi =
   1274 				    (struct nd_opt_prefix_info *)hdr;
   1275 				continue;
   1276 			}
   1277 			if ((pfxlist = malloc(sizeof(*pfxlist))) == NULL) {
   1278 				syslog(LOG_ERR, "<%s> can't allocate memory",
   1279 				    __func__);
   1280 				goto bad;
   1281 			}
   1282 			pfxlist->next = ndopts->nd_opts_list;
   1283 			pfxlist->opt = hdr;
   1284 			ndopts->nd_opts_list = pfxlist;
   1285 
   1286 			break;
   1287 		}
   1288 		default:	/* impossible */
   1289 			break;
   1290 		}
   1291 	}
   1292 
   1293 	return(0);
   1294 
   1295   bad:
   1296 	free_ndopts(ndopts);
   1297 
   1298 	return(-1);
   1299 }
   1300 
   1301 static void
   1302 free_ndopts(union nd_opts *ndopts)
   1303 {
   1304 	struct nd_optlist *opt = ndopts->nd_opts_list, *next;
   1305 
   1306 	while (opt) {
   1307 		next = opt->next;
   1308 		free(opt);
   1309 		opt = next;
   1310 	}
   1311 }
   1312 
   1313 void
   1314 sock_open()
   1315 {
   1316 	struct icmp6_filter filt;
   1317 	struct ipv6_mreq mreq;
   1318 	struct rainfo *ra = ralist;
   1319 	int on;
   1320 	/* XXX: should be max MTU attached to the node */
   1321 	static u_char answer[1500];
   1322 
   1323 	rcvcmsgbuflen = CMSG_SPACE(sizeof(struct in6_pktinfo)) +
   1324 				CMSG_SPACE(sizeof(int));
   1325 	rcvcmsgbuf = (u_char *)malloc(rcvcmsgbuflen);
   1326 	if (rcvcmsgbuf == NULL) {
   1327 		syslog(LOG_ERR, "<%s> not enough core", __func__);
   1328 		exit(1);
   1329 	}
   1330 
   1331 	sndcmsgbuflen = CMSG_SPACE(sizeof(struct in6_pktinfo)) +
   1332 				CMSG_SPACE(sizeof(int));
   1333 	sndcmsgbuf = (u_char *)malloc(sndcmsgbuflen);
   1334 	if (sndcmsgbuf == NULL) {
   1335 		syslog(LOG_ERR, "<%s> not enough core", __func__);
   1336 		exit(1);
   1337 	}
   1338 
   1339 	if ((sock = socket(AF_INET6, SOCK_RAW, IPPROTO_ICMPV6)) < 0) {
   1340 		syslog(LOG_ERR, "<%s> socket: %s", __func__,
   1341 		       strerror(errno));
   1342 		exit(1);
   1343 	}
   1344 
   1345 	/* specify to tell receiving interface */
   1346 	on = 1;
   1347 #ifdef IPV6_RECVPKTINFO
   1348 	if (setsockopt(sock, IPPROTO_IPV6, IPV6_RECVPKTINFO, &on,
   1349 		       sizeof(on)) < 0) {
   1350 		syslog(LOG_ERR, "<%s> IPV6_RECVPKTINFO: %s",
   1351 		       __func__, strerror(errno));
   1352 		exit(1);
   1353 	}
   1354 #else  /* old adv. API */
   1355 	if (setsockopt(sock, IPPROTO_IPV6, IPV6_PKTINFO, &on,
   1356 		       sizeof(on)) < 0) {
   1357 		syslog(LOG_ERR, "<%s> IPV6_PKTINFO: %s",
   1358 		       __func__, strerror(errno));
   1359 		exit(1);
   1360 	}
   1361 #endif
   1362 
   1363 	on = 1;
   1364 	/* specify to tell value of hoplimit field of received IP6 hdr */
   1365 #ifdef IPV6_RECVHOPLIMIT
   1366 	if (setsockopt(sock, IPPROTO_IPV6, IPV6_RECVHOPLIMIT, &on,
   1367 		       sizeof(on)) < 0) {
   1368 		syslog(LOG_ERR, "<%s> IPV6_RECVHOPLIMIT: %s",
   1369 		       __func__, strerror(errno));
   1370 		exit(1);
   1371 	}
   1372 #else  /* old adv. API */
   1373 	if (setsockopt(sock, IPPROTO_IPV6, IPV6_HOPLIMIT, &on,
   1374 		       sizeof(on)) < 0) {
   1375 		syslog(LOG_ERR, "<%s> IPV6_HOPLIMIT: %s",
   1376 		       __func__, strerror(errno));
   1377 		exit(1);
   1378 	}
   1379 #endif
   1380 
   1381 	ICMP6_FILTER_SETBLOCKALL(&filt);
   1382 	ICMP6_FILTER_SETPASS(ND_ROUTER_SOLICIT, &filt);
   1383 	ICMP6_FILTER_SETPASS(ND_ROUTER_ADVERT, &filt);
   1384 	if (accept_rr)
   1385 		ICMP6_FILTER_SETPASS(ICMP6_ROUTER_RENUMBERING, &filt);
   1386 	if (setsockopt(sock, IPPROTO_ICMPV6, ICMP6_FILTER, &filt,
   1387 		       sizeof(filt)) < 0) {
   1388 		syslog(LOG_ERR, "<%s> IICMP6_FILTER: %s",
   1389 		       __func__, strerror(errno));
   1390 		exit(1);
   1391 	}
   1392 
   1393 	/*
   1394 	 * join all routers multicast address on each advertising interface.
   1395 	 */
   1396 	if (inet_pton(AF_INET6, ALLROUTERS_LINK,
   1397 		      &mreq.ipv6mr_multiaddr.s6_addr)
   1398 	    != 1) {
   1399 		syslog(LOG_ERR, "<%s> inet_pton failed(library bug?)",
   1400 		       __func__);
   1401 		exit(1);
   1402 	}
   1403 	while (ra) {
   1404 		mreq.ipv6mr_interface = ra->ifindex;
   1405 		if (setsockopt(sock, IPPROTO_IPV6, IPV6_JOIN_GROUP, &mreq,
   1406 			       sizeof(mreq)) < 0) {
   1407 			syslog(LOG_ERR, "<%s> IPV6_JOIN_GROUP(link) on %s: %s",
   1408 			       __func__, ra->ifname, strerror(errno));
   1409 			exit(1);
   1410 		}
   1411 		ra = ra->next;
   1412 	}
   1413 
   1414 	/*
   1415 	 * When attending router renumbering, join all-routers site-local
   1416 	 * multicast group.
   1417 	 */
   1418 	if (accept_rr) {
   1419 		if (inet_pton(AF_INET6, ALLROUTERS_SITE,
   1420 			      &in6a_site_allrouters) != 1) {
   1421 			syslog(LOG_ERR, "<%s> inet_pton failed(library bug?)",
   1422 			       __func__);
   1423 			exit(1);
   1424 		}
   1425 		mreq.ipv6mr_multiaddr = in6a_site_allrouters;
   1426 		if (mcastif) {
   1427 			if ((mreq.ipv6mr_interface = if_nametoindex(mcastif))
   1428 			    == 0) {
   1429 				syslog(LOG_ERR,
   1430 				       "<%s> invalid interface: %s",
   1431 				       __func__, mcastif);
   1432 				exit(1);
   1433 			}
   1434 		} else
   1435 			mreq.ipv6mr_interface = ralist->ifindex;
   1436 		if (setsockopt(sock, IPPROTO_IPV6, IPV6_JOIN_GROUP,
   1437 			       &mreq, sizeof(mreq)) < 0) {
   1438 			syslog(LOG_ERR,
   1439 			       "<%s> IPV6_JOIN_GROUP(site) on %s: %s",
   1440 			       __func__,
   1441 			       mcastif ? mcastif : ralist->ifname,
   1442 			       strerror(errno));
   1443 			exit(1);
   1444 		}
   1445 	}
   1446 
   1447 	/* initialize msghdr for receiving packets */
   1448 	rcviov[0].iov_base = (caddr_t)answer;
   1449 	rcviov[0].iov_len = sizeof(answer);
   1450 	rcvmhdr.msg_name = (caddr_t)&rcvfrom;
   1451 	rcvmhdr.msg_namelen = sizeof(rcvfrom);
   1452 	rcvmhdr.msg_iov = rcviov;
   1453 	rcvmhdr.msg_iovlen = 1;
   1454 	rcvmhdr.msg_control = (caddr_t) rcvcmsgbuf;
   1455 	rcvmhdr.msg_controllen = rcvcmsgbuflen;
   1456 
   1457 	/* initialize msghdr for sending packets */
   1458 	sndmhdr.msg_namelen = sizeof(struct sockaddr_in6);
   1459 	sndmhdr.msg_iov = sndiov;
   1460 	sndmhdr.msg_iovlen = 1;
   1461 	sndmhdr.msg_control = (caddr_t)sndcmsgbuf;
   1462 	sndmhdr.msg_controllen = sndcmsgbuflen;
   1463 
   1464 	return;
   1465 }
   1466 
   1467 /* open a routing socket to watch the routing table */
   1468 static void
   1469 rtsock_open()
   1470 {
   1471 	if ((rtsock = socket(PF_ROUTE, SOCK_RAW, 0)) < 0) {
   1472 		syslog(LOG_ERR,
   1473 		       "<%s> socket: %s", __func__, strerror(errno));
   1474 		exit(1);
   1475 	}
   1476 }
   1477 
   1478 struct rainfo *
   1479 if_indextorainfo(int index)
   1480 {
   1481 	struct rainfo *rai = ralist;
   1482 
   1483 	for (rai = ralist; rai; rai = rai->next) {
   1484 		if (rai->ifindex == index)
   1485 			return(rai);
   1486 	}
   1487 
   1488 	return(NULL);		/* search failed */
   1489 }
   1490 
   1491 static void
   1492 ra_output(rainfo)
   1493 struct rainfo *rainfo;
   1494 {
   1495 	int i;
   1496 	struct cmsghdr *cm;
   1497 	struct in6_pktinfo *pi;
   1498 	struct soliciter *sol, *nextsol;
   1499 
   1500 	if ((iflist[rainfo->ifindex]->ifm_flags & IFF_UP) == 0) {
   1501 		syslog(LOG_DEBUG, "<%s> %s is not up, skip sending RA",
   1502 		       __func__, rainfo->ifname);
   1503 		return;
   1504 	}
   1505 
   1506 	make_packet(rainfo);	/* XXX: inefficient */
   1507 
   1508 	sndmhdr.msg_name = (caddr_t)&sin6_allnodes;
   1509 	sndmhdr.msg_iov[0].iov_base = (caddr_t)rainfo->ra_data;
   1510 	sndmhdr.msg_iov[0].iov_len = rainfo->ra_datalen;
   1511 
   1512 	cm = CMSG_FIRSTHDR(&sndmhdr);
   1513 	/* specify the outgoing interface */
   1514 	cm->cmsg_level = IPPROTO_IPV6;
   1515 	cm->cmsg_type = IPV6_PKTINFO;
   1516 	cm->cmsg_len = CMSG_LEN(sizeof(struct in6_pktinfo));
   1517 	pi = (struct in6_pktinfo *)CMSG_DATA(cm);
   1518 	memset(&pi->ipi6_addr, 0, sizeof(pi->ipi6_addr));	/*XXX*/
   1519 	pi->ipi6_ifindex = rainfo->ifindex;
   1520 
   1521 	/* specify the hop limit of the packet */
   1522 	{
   1523 		int hoplimit = 255;
   1524 
   1525 		cm = CMSG_NXTHDR(&sndmhdr, cm);
   1526 		cm->cmsg_level = IPPROTO_IPV6;
   1527 		cm->cmsg_type = IPV6_HOPLIMIT;
   1528 		cm->cmsg_len = CMSG_LEN(sizeof(int));
   1529 		memcpy(CMSG_DATA(cm), &hoplimit, sizeof(int));
   1530 	}
   1531 
   1532 	syslog(LOG_DEBUG,
   1533 	       "<%s> send RA on %s, # of waitings = %d",
   1534 	       __func__, rainfo->ifname, rainfo->waiting);
   1535 
   1536 	i = sendmsg(sock, &sndmhdr, 0);
   1537 
   1538 	if (i < 0 || i != rainfo->ra_datalen)  {
   1539 		if (i < 0) {
   1540 			syslog(LOG_ERR, "<%s> sendmsg on %s: %s",
   1541 			       __func__, rainfo->ifname,
   1542 			       strerror(errno));
   1543 		}
   1544 	}
   1545 
   1546 	/*
   1547 	 * unicast advertisements
   1548 	 * XXX commented out.  reason: though spec does not forbit it, unicast
   1549 	 * advert does not really help
   1550 	 */
   1551 	for (sol = rainfo->soliciter; sol; sol = nextsol) {
   1552 		nextsol = sol->next;
   1553 
   1554 #if 0
   1555 		sndmhdr.msg_name = (caddr_t)&sol->addr;
   1556 		i = sendmsg(sock, &sndmhdr, 0);
   1557 		if (i < 0 || i != rainfo->ra_datalen)  {
   1558 			if (i < 0) {
   1559 				syslog(LOG_ERR,
   1560 				    "<%s> unicast sendmsg on %s: %s",
   1561 				    __func__, rainfo->ifname,
   1562 				    strerror(errno));
   1563 			}
   1564 		}
   1565 #endif
   1566 
   1567 		sol->next = NULL;
   1568 		free(sol);
   1569 	}
   1570 	rainfo->soliciter = NULL;
   1571 
   1572 	/* update counter */
   1573 	if (rainfo->initcounter < MAX_INITIAL_RTR_ADVERTISEMENTS)
   1574 		rainfo->initcounter++;
   1575 	rainfo->raoutput++;
   1576 
   1577 	/* update timestamp */
   1578 	gettimeofday(&rainfo->lastsent, NULL);
   1579 
   1580 	/* reset waiting conter */
   1581 	rainfo->waiting = 0;
   1582 }
   1583 
   1584 /* process RA timer */
   1585 struct rtadvd_timer *
   1586 ra_timeout(void *data)
   1587 {
   1588 	struct rainfo *rai = (struct rainfo *)data;
   1589 
   1590 #ifdef notyet
   1591 	/* if necessary, reconstruct the packet. */
   1592 #endif
   1593 
   1594 	syslog(LOG_DEBUG,
   1595 	       "<%s> RA timer on %s is expired",
   1596 	       __func__, rai->ifname);
   1597 
   1598 	ra_output(rai);
   1599 
   1600 	return(rai->timer);
   1601 }
   1602 
   1603 /* update RA timer */
   1604 void
   1605 ra_timer_update(void *data, struct timeval *tm)
   1606 {
   1607 	struct rainfo *rai = (struct rainfo *)data;
   1608 	long interval;
   1609 
   1610 	/*
   1611 	 * Whenever a multicast advertisement is sent from an interface,
   1612 	 * the timer is reset to a uniformly-distributed random value
   1613 	 * between the interface's configured MinRtrAdvInterval and
   1614 	 * MaxRtrAdvInterval (RFC2461 6.2.4).
   1615 	 */
   1616 	interval = rai->mininterval;
   1617 	interval += arc4random() % (rai->maxinterval - rai->mininterval);
   1618 
   1619 	/*
   1620 	 * For the first few advertisements (up to
   1621 	 * MAX_INITIAL_RTR_ADVERTISEMENTS), if the randomly chosen interval
   1622 	 * is greater than MAX_INITIAL_RTR_ADVERT_INTERVAL, the timer
   1623 	 * SHOULD be set to MAX_INITIAL_RTR_ADVERT_INTERVAL instead.
   1624 	 * (RFC-2461 6.2.4)
   1625 	 */
   1626 	if (rai->initcounter < MAX_INITIAL_RTR_ADVERTISEMENTS &&
   1627 	    interval > MAX_INITIAL_RTR_ADVERT_INTERVAL)
   1628 		interval = MAX_INITIAL_RTR_ADVERT_INTERVAL;
   1629 
   1630 	tm->tv_sec = interval;
   1631 	tm->tv_usec = 0;
   1632 
   1633 	syslog(LOG_DEBUG,
   1634 	       "<%s> RA timer on %s is set to %ld:%ld",
   1635 	       __func__, rai->ifname,
   1636 	       (long int)tm->tv_sec, (long int)tm->tv_usec);
   1637 
   1638 	return;
   1639 }
   1640