rtadvd.c revision 1.2 1 1.2 itojun /* $NetBSD: rtadvd.c,v 1.2 1999/07/06 13:02:09 itojun Exp $ */
2 1.2 itojun
3 1.1 itojun /*
4 1.1 itojun * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project.
5 1.1 itojun * All rights reserved.
6 1.1 itojun *
7 1.1 itojun * Redistribution and use in source and binary forms, with or without
8 1.1 itojun * modification, are permitted provided that the following conditions
9 1.1 itojun * are met:
10 1.1 itojun * 1. Redistributions of source code must retain the above copyright
11 1.1 itojun * notice, this list of conditions and the following disclaimer.
12 1.1 itojun * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 itojun * notice, this list of conditions and the following disclaimer in the
14 1.1 itojun * documentation and/or other materials provided with the distribution.
15 1.1 itojun * 3. Neither the name of the project nor the names of its contributors
16 1.1 itojun * may be used to endorse or promote products derived from this software
17 1.1 itojun * without specific prior written permission.
18 1.1 itojun *
19 1.1 itojun * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
20 1.1 itojun * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
21 1.1 itojun * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
22 1.1 itojun * ARE DISCLAIMED. IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
23 1.1 itojun * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
24 1.1 itojun * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
25 1.1 itojun * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
26 1.1 itojun * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
27 1.1 itojun * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
28 1.1 itojun * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
29 1.1 itojun * SUCH DAMAGE.
30 1.1 itojun */
31 1.1 itojun
32 1.1 itojun #include <sys/param.h>
33 1.1 itojun #include <sys/socket.h>
34 1.1 itojun #include <sys/uio.h>
35 1.1 itojun #include <sys/time.h>
36 1.1 itojun
37 1.1 itojun #include <net/if.h>
38 1.1 itojun #include <net/route.h>
39 1.1 itojun #include <net/if_dl.h>
40 1.1 itojun #include <netinet/in.h>
41 1.1 itojun #include <netinet/ip6.h>
42 1.1 itojun #include <netinet6/ip6_var.h>
43 1.1 itojun #include <netinet/icmp6.h>
44 1.1 itojun
45 1.1 itojun #include <arpa/inet.h>
46 1.1 itojun
47 1.1 itojun #include <time.h>
48 1.1 itojun #include <unistd.h>
49 1.1 itojun #include <stdio.h>
50 1.1 itojun #include <err.h>
51 1.1 itojun #include <errno.h>
52 1.1 itojun #include <string.h>
53 1.1 itojun #include <stdlib.h>
54 1.1 itojun #include <syslog.h>
55 1.1 itojun #include "rtadvd.h"
56 1.1 itojun #include "rrenum.h"
57 1.1 itojun #include "advcap.h"
58 1.1 itojun #include "timer.h"
59 1.1 itojun #include "if.h"
60 1.1 itojun #include "config.h"
61 1.1 itojun
62 1.1 itojun struct msghdr rcvmhdr;
63 1.1 itojun static u_char rcvcmsgbuf[CMSG_SPACE(sizeof(struct in6_pktinfo)) +
64 1.1 itojun CMSG_SPACE(sizeof(int))];
65 1.1 itojun struct msghdr sndmhdr;
66 1.1 itojun struct iovec rcviov[2];
67 1.1 itojun struct iovec sndiov[2];
68 1.1 itojun struct sockaddr_in6 from;
69 1.1 itojun struct sockaddr_in6 sin6_allnodes = {sizeof(sin6_allnodes), AF_INET6};
70 1.1 itojun int sock, rtsock;
71 1.1 itojun int accept_rr = 1;
72 1.1 itojun int dflag = 0, sflag = 0;
73 1.1 itojun
74 1.1 itojun u_char *conffile = NULL;
75 1.1 itojun
76 1.1 itojun struct rainfo *ralist = NULL;
77 1.1 itojun struct nd_optlist {
78 1.1 itojun struct nd_optlist *next;
79 1.1 itojun struct nd_opt_hdr *opt;
80 1.1 itojun };
81 1.1 itojun union nd_opts {
82 1.1 itojun struct nd_opt_hdr *nd_opt_array[7];
83 1.1 itojun struct {
84 1.1 itojun struct nd_opt_hdr *zero;
85 1.1 itojun struct nd_opt_hdr *src_lladdr;
86 1.1 itojun struct nd_opt_hdr *tgt_lladdr;
87 1.1 itojun struct nd_opt_prefix_info *pi;
88 1.1 itojun struct nd_opt_rd_hdr *rh;
89 1.1 itojun struct nd_opt_mtu *mtu;
90 1.1 itojun struct nd_optlist *list;
91 1.1 itojun } nd_opt_each;
92 1.1 itojun };
93 1.1 itojun #define nd_opts_src_lladdr nd_opt_each.src_lladdr
94 1.1 itojun #define nd_opts_tgt_lladdr nd_opt_each.tgt_lladdr
95 1.1 itojun #define nd_opts_pi nd_opt_each.pi
96 1.1 itojun #define nd_opts_rh nd_opt_each.rh
97 1.1 itojun #define nd_opts_mtu nd_opt_each.mtu
98 1.1 itojun #define nd_opts_list nd_opt_each.list
99 1.1 itojun
100 1.1 itojun #define NDOPT_FLAG_SRCLINKADDR 0x1
101 1.1 itojun #define NDOPT_FLAG_TGTLINKADDR 0x2
102 1.1 itojun #define NDOPT_FLAG_PREFIXINFO 0x4
103 1.1 itojun #define NDOPT_FLAG_RDHDR 0x8
104 1.1 itojun #define NDOPT_FLAG_MTU 0x10
105 1.1 itojun
106 1.1 itojun u_int32_t ndopt_flags[] = {
107 1.1 itojun 0, NDOPT_FLAG_SRCLINKADDR, NDOPT_FLAG_TGTLINKADDR,
108 1.1 itojun NDOPT_FLAG_PREFIXINFO, NDOPT_FLAG_RDHDR, NDOPT_FLAG_MTU
109 1.1 itojun };
110 1.1 itojun
111 1.1 itojun int main __P((int, char *[]));
112 1.1 itojun static void sock_open __P((void));
113 1.1 itojun static void rtsock_open __P((void));
114 1.1 itojun static void rtadvd_input __P((void));
115 1.1 itojun static void rs_input __P((int, struct nd_router_solicit *,
116 1.1 itojun struct in6_pktinfo *, struct sockaddr_in6 *));
117 1.1 itojun static void ra_input __P((int, struct nd_router_advert *,
118 1.1 itojun struct in6_pktinfo *, struct sockaddr_in6 *));
119 1.1 itojun static void prefix_check __P((struct nd_opt_prefix_info *, struct rainfo *,
120 1.1 itojun struct sockaddr_in6 *));
121 1.1 itojun static int nd6_options __P((struct nd_opt_hdr *, int,
122 1.1 itojun union nd_opts *, u_int32_t));
123 1.1 itojun static void free_ndopts __P((union nd_opts *));
124 1.1 itojun static struct rainfo *if_indextorainfo __P((int));
125 1.1 itojun static void ra_output __P((struct rainfo *));
126 1.1 itojun static void rtmsg_input __P((void));
127 1.1 itojun struct prefix *find_prefix __P((struct rainfo *, struct in6_addr *, int));
128 1.1 itojun
129 1.1 itojun
130 1.1 itojun int
131 1.1 itojun main(argc, argv)
132 1.1 itojun int argc;
133 1.1 itojun char *argv[];
134 1.1 itojun {
135 1.1 itojun fd_set fdset;
136 1.1 itojun int maxfd = 0;
137 1.1 itojun struct timeval *timeout;
138 1.1 itojun int i, ch;
139 1.1 itojun int fflag = 0;
140 1.1 itojun
141 1.1 itojun openlog(*argv, LOG_NDELAY|LOG_PID, LOG_DAEMON);
142 1.1 itojun
143 1.1 itojun /* get command line options and arguments */
144 1.1 itojun while ((ch = getopt(argc, argv, "c:dDfs")) != -1) {
145 1.1 itojun switch(ch) {
146 1.1 itojun case 'c':
147 1.1 itojun conffile = optarg;
148 1.1 itojun break;
149 1.1 itojun case 'd':
150 1.1 itojun dflag = 1;
151 1.1 itojun break;
152 1.1 itojun case 'D':
153 1.1 itojun dflag = 2;
154 1.1 itojun break;
155 1.1 itojun case 'f':
156 1.1 itojun fflag = 1;
157 1.1 itojun break;
158 1.1 itojun case 's':
159 1.1 itojun sflag = 1;
160 1.1 itojun }
161 1.1 itojun }
162 1.1 itojun argc -= optind;
163 1.1 itojun argv += optind;
164 1.1 itojun if (argc == 0) {
165 1.1 itojun fprintf(stderr,
166 1.1 itojun "usage: rtadvd [-c conffile] [-d|D] [-f] [-s]"
167 1.1 itojun "interfaces...\n");
168 1.1 itojun exit(1);
169 1.1 itojun }
170 1.1 itojun
171 1.1 itojun /* set log level */
172 1.1 itojun if (dflag == 0)
173 1.1 itojun (void)setlogmask(LOG_UPTO(LOG_ERR));
174 1.1 itojun if (dflag == 1)
175 1.1 itojun (void)setlogmask(LOG_UPTO(LOG_INFO));
176 1.1 itojun
177 1.1 itojun /* timer initialization */
178 1.1 itojun rtadvd_timer_init();
179 1.1 itojun
180 1.1 itojun /* random value initialization */
181 1.1 itojun srandom((u_long)time(NULL));
182 1.1 itojun
183 1.1 itojun /* get iflist block from kernel */
184 1.1 itojun init_iflist();
185 1.1 itojun
186 1.1 itojun while (argc--)
187 1.1 itojun getconfig(*argv++);
188 1.1 itojun
189 1.1 itojun inet_pton(AF_INET6, ALLNODES, &sin6_allnodes.sin6_addr);
190 1.1 itojun sock_open();
191 1.1 itojun
192 1.1 itojun if (!fflag)
193 1.1 itojun daemon(1, 0);
194 1.1 itojun
195 1.1 itojun FD_ZERO(&fdset);
196 1.1 itojun FD_SET(sock, &fdset);
197 1.1 itojun maxfd = sock;
198 1.1 itojun if (sflag == 0) {
199 1.1 itojun rtsock_open();
200 1.1 itojun FD_SET(rtsock, &fdset);
201 1.1 itojun if (rtsock > sock)
202 1.1 itojun maxfd = rtsock;
203 1.1 itojun }
204 1.1 itojun
205 1.1 itojun while (1) {
206 1.1 itojun struct fd_set select_fd = fdset; /* reinitialize */
207 1.1 itojun
208 1.1 itojun /* timer expiration check and reset the timer */
209 1.1 itojun timeout = rtadvd_check_timer();
210 1.1 itojun
211 1.1 itojun syslog(LOG_DEBUG,
212 1.1 itojun "<%s> set timer to %ld:%ld. waiting for inputs "
213 1.1 itojun "or timeout",
214 1.1 itojun __FUNCTION__,
215 1.1 itojun timeout->tv_sec, timeout->tv_usec);
216 1.1 itojun
217 1.1 itojun if ((i = select(maxfd + 1, &select_fd,
218 1.1 itojun NULL, NULL, timeout)) < 0){
219 1.1 itojun syslog(LOG_ERR, "<%s> select: %s",
220 1.1 itojun __FUNCTION__, strerror(errno));
221 1.1 itojun continue;
222 1.1 itojun }
223 1.1 itojun if (i == 0) /* timeout */
224 1.1 itojun continue;
225 1.1 itojun if (sflag == 0 && FD_ISSET(rtsock, &select_fd))
226 1.1 itojun rtmsg_input();
227 1.1 itojun if (FD_ISSET(sock, &select_fd))
228 1.1 itojun rtadvd_input();
229 1.1 itojun }
230 1.1 itojun exit(0); /* NOTREACHED */
231 1.1 itojun }
232 1.1 itojun
233 1.1 itojun static void
234 1.1 itojun rtmsg_input()
235 1.1 itojun {
236 1.2 itojun int n, type, ifindex, plen;
237 1.2 itojun size_t len;
238 1.1 itojun char msg[2048], *next, *lim;
239 1.1 itojun u_char ifname[16];
240 1.1 itojun struct prefix *prefix;
241 1.1 itojun struct rainfo *rai;
242 1.1 itojun struct in6_addr *addr;
243 1.1 itojun char addrbuf[INET6_ADDRSTRLEN];
244 1.1 itojun
245 1.1 itojun n = read(rtsock, msg, 2048);
246 1.1 itojun if (dflag > 1) {
247 1.1 itojun syslog(LOG_DEBUG,
248 1.1 itojun "<%s> received a routing message "
249 1.1 itojun "(type = %d, len = %d)",
250 1.1 itojun __FUNCTION__,
251 1.1 itojun rtmsg_type(msg), n);
252 1.1 itojun }
253 1.1 itojun if (n > rtmsg_len(msg)) {
254 1.1 itojun /*
255 1.1 itojun * This usually won't happen for messages received on
256 1.1 itojun * an routing socket.
257 1.1 itojun */
258 1.1 itojun if (dflag > 1)
259 1.1 itojun syslog(LOG_DEBUG,
260 1.1 itojun "<%s> received data length is larger than"
261 1.1 itojun "1st routing message len. multiple messages?"
262 1.1 itojun " read %d bytes, but 1st msg len = %d",
263 1.1 itojun __FUNCTION__, n, rtmsg_len(msg));
264 1.1 itojun #if 0
265 1.1 itojun /* adjust length */
266 1.1 itojun n = rtmsg_len(msg);
267 1.1 itojun #endif
268 1.1 itojun }
269 1.1 itojun
270 1.1 itojun lim = msg + n;
271 1.1 itojun for (next = msg; next < lim; next += len) {
272 1.1 itojun next = get_next_msg(next, lim, 0, &len,
273 1.1 itojun RTADV_TYPE2BITMASK(RTM_ADD) |
274 1.1 itojun RTADV_TYPE2BITMASK(RTM_DELETE) |
275 1.1 itojun RTADV_TYPE2BITMASK(RTM_NEWADDR) |
276 1.1 itojun RTADV_TYPE2BITMASK(RTM_DELADDR) |
277 1.1 itojun RTADV_TYPE2BITMASK(RTM_IFINFO));
278 1.1 itojun if (len == 0)
279 1.1 itojun break;
280 1.1 itojun type = rtmsg_type(next);
281 1.1 itojun switch (type) {
282 1.1 itojun case RTM_ADD:
283 1.1 itojun case RTM_DELETE:
284 1.1 itojun ifindex = get_rtm_ifindex(next);
285 1.1 itojun break;
286 1.1 itojun case RTM_NEWADDR:
287 1.1 itojun case RTM_DELADDR:
288 1.1 itojun ifindex = get_ifam_ifindex(next);
289 1.1 itojun break;
290 1.1 itojun case RTM_IFINFO:
291 1.1 itojun ifindex = get_ifm_ifindex(next);
292 1.1 itojun break;
293 1.1 itojun default:
294 1.1 itojun /* should not reach here */
295 1.1 itojun if (dflag > 1) {
296 1.1 itojun syslog(LOG_DEBUG,
297 1.1 itojun "<%s:%d> unknown rtmsg %d on %s",
298 1.1 itojun __FUNCTION__, __LINE__, type,
299 1.1 itojun if_indextoname(ifindex, ifname));
300 1.1 itojun }
301 1.1 itojun return;
302 1.1 itojun }
303 1.1 itojun
304 1.1 itojun if ((rai = if_indextorainfo(ifindex)) == NULL) {
305 1.1 itojun if (dflag > 1) {
306 1.1 itojun syslog(LOG_DEBUG,
307 1.1 itojun "<%s> route changed on "
308 1.1 itojun "non advertising interface(%s)",
309 1.1 itojun __FUNCTION__,
310 1.1 itojun if_indextoname(ifindex, ifname));
311 1.1 itojun }
312 1.1 itojun return;
313 1.1 itojun }
314 1.1 itojun
315 1.1 itojun switch(type) {
316 1.1 itojun case RTM_ADD:
317 1.1 itojun /* init iffalgs because it may have changed */
318 1.1 itojun iflist[ifindex]->ifm_flags =
319 1.1 itojun if_getflags(ifindex,
320 1.1 itojun iflist[ifindex]->ifm_flags);
321 1.1 itojun
322 1.1 itojun addr = get_addr(msg);
323 1.1 itojun plen = get_prefixlen(msg);
324 1.1 itojun /* sanity check for plen */
325 1.1 itojun if (plen < 4 /* as RFC2373, prefixlen is at least 4 */
326 1.1 itojun || plen > 127) {
327 1.1 itojun syslog(LOG_INFO, "<%s> new interface route's"
328 1.1 itojun "plen %d is invalid for a prefix",
329 1.1 itojun __FUNCTION__, plen);
330 1.1 itojun return;
331 1.1 itojun }
332 1.1 itojun prefix = find_prefix(rai, addr, plen);
333 1.1 itojun if (prefix) {
334 1.1 itojun if (dflag > 1) {
335 1.1 itojun syslog(LOG_DEBUG,
336 1.1 itojun "<%s> new prefix(%s/%d) "
337 1.1 itojun "added on %s, "
338 1.1 itojun "but it was already in list",
339 1.1 itojun __FUNCTION__,
340 1.1 itojun inet_ntop(AF_INET6,
341 1.1 itojun addr, (char *)addrbuf,
342 1.1 itojun INET6_ADDRSTRLEN),
343 1.1 itojun plen,
344 1.1 itojun rai->ifname);
345 1.1 itojun }
346 1.1 itojun return;
347 1.1 itojun }
348 1.1 itojun make_prefix(rai, ifindex, addr, plen);
349 1.1 itojun break;
350 1.1 itojun case RTM_DELETE:
351 1.1 itojun /* init ifflags because it may have changed */
352 1.1 itojun iflist[ifindex]->ifm_flags =
353 1.1 itojun if_getflags(ifindex,
354 1.1 itojun iflist[ifindex]->ifm_flags);
355 1.1 itojun
356 1.1 itojun addr = get_addr(msg);
357 1.1 itojun plen = get_prefixlen(msg);
358 1.1 itojun /* sanity check for plen */
359 1.1 itojun if (plen < 4 /* as RFC2373, prefixlen is at least 4 */
360 1.1 itojun || plen > 127) {
361 1.1 itojun syslog(LOG_INFO, "<%s> deleted interface"
362 1.1 itojun "route's"
363 1.1 itojun "plen %d is invalid for a prefix",
364 1.1 itojun __FUNCTION__, plen);
365 1.1 itojun return;
366 1.1 itojun }
367 1.1 itojun prefix = find_prefix(rai, addr, plen);
368 1.1 itojun if (prefix == NULL) {
369 1.1 itojun if (dflag > 1) {
370 1.1 itojun syslog(LOG_DEBUG,
371 1.1 itojun "<%s> prefix(%s/%d) was "
372 1.1 itojun "deleted on %s, "
373 1.1 itojun "but it was not in list",
374 1.1 itojun __FUNCTION__,
375 1.1 itojun inet_ntop(AF_INET6,
376 1.1 itojun addr, (char *)addrbuf,
377 1.1 itojun INET6_ADDRSTRLEN),
378 1.1 itojun plen,
379 1.1 itojun rai->ifname);
380 1.1 itojun }
381 1.1 itojun return;
382 1.1 itojun }
383 1.1 itojun delete_prefix(rai, prefix);
384 1.1 itojun break;
385 1.1 itojun case RTM_NEWADDR:
386 1.1 itojun case RTM_DELADDR:
387 1.1 itojun /* init ifflags because it may have changed */
388 1.1 itojun iflist[ifindex]->ifm_flags =
389 1.1 itojun if_getflags(ifindex,
390 1.1 itojun iflist[ifindex]->ifm_flags);
391 1.1 itojun break;
392 1.1 itojun case RTM_IFINFO:
393 1.1 itojun iflist[ifindex]->ifm_flags = get_ifm_flags(next);
394 1.1 itojun break;
395 1.1 itojun default:
396 1.1 itojun /* should not reach here */
397 1.1 itojun if (dflag > 1) {
398 1.1 itojun syslog(LOG_DEBUG,
399 1.1 itojun "<%s:%d> unknown rtmsg %d on %s",
400 1.1 itojun __FUNCTION__, __LINE__, type,
401 1.1 itojun if_indextoname(ifindex, ifname));
402 1.1 itojun }
403 1.1 itojun return;
404 1.1 itojun }
405 1.1 itojun }
406 1.1 itojun
407 1.1 itojun return;
408 1.1 itojun }
409 1.1 itojun
410 1.1 itojun void
411 1.1 itojun rtadvd_input()
412 1.1 itojun {
413 1.1 itojun int i;
414 1.1 itojun int *hlimp = NULL;
415 1.1 itojun #ifdef OLDRAWSOCKET
416 1.1 itojun struct ip6_hdr *ip;
417 1.1 itojun #endif
418 1.1 itojun struct icmp6_hdr *icp;
419 1.1 itojun int ifindex = 0;
420 1.1 itojun struct cmsghdr *cm;
421 1.1 itojun struct in6_pktinfo *pi = NULL;
422 1.1 itojun u_char ntopbuf[INET6_ADDRSTRLEN], ifnamebuf[IFNAMSIZ];
423 1.1 itojun struct in6_addr dst = in6addr_any;
424 1.1 itojun
425 1.1 itojun /*
426 1.1 itojun * Get message. We reset msg_controllen since the field could
427 1.1 itojun * be modified if we had received a message before setting
428 1.1 itojun * receive options.
429 1.1 itojun */
430 1.1 itojun rcvmhdr.msg_controllen = sizeof(rcvcmsgbuf);
431 1.1 itojun if ((i = recvmsg(sock, &rcvmhdr, 0)) < 0)
432 1.1 itojun return;
433 1.1 itojun
434 1.1 itojun /* extract optional information via Advanced API */
435 1.1 itojun for (cm = (struct cmsghdr *)CMSG_FIRSTHDR(&rcvmhdr);
436 1.1 itojun cm;
437 1.1 itojun cm = (struct cmsghdr *)CMSG_NXTHDR(&rcvmhdr, cm)) {
438 1.1 itojun if (cm->cmsg_level == IPPROTO_IPV6 &&
439 1.1 itojun cm->cmsg_type == IPV6_PKTINFO &&
440 1.1 itojun cm->cmsg_len == CMSG_LEN(sizeof(struct in6_pktinfo))) {
441 1.1 itojun pi = (struct in6_pktinfo *)(CMSG_DATA(cm));
442 1.1 itojun ifindex = pi->ipi6_ifindex;
443 1.1 itojun dst = pi->ipi6_addr;
444 1.1 itojun }
445 1.1 itojun if (cm->cmsg_level == IPPROTO_IPV6 &&
446 1.1 itojun cm->cmsg_type == IPV6_HOPLIMIT &&
447 1.1 itojun cm->cmsg_len == CMSG_LEN(sizeof(int)))
448 1.1 itojun hlimp = (int *)CMSG_DATA(cm);
449 1.1 itojun }
450 1.1 itojun if (ifindex == 0) {
451 1.1 itojun syslog(LOG_ERR,
452 1.1 itojun "<%s> failed to get receiving interface",
453 1.1 itojun __FUNCTION__);
454 1.1 itojun return;
455 1.1 itojun }
456 1.1 itojun if (hlimp == NULL) {
457 1.1 itojun syslog(LOG_ERR,
458 1.1 itojun "<%s> failed to get receiving hop limit",
459 1.1 itojun __FUNCTION__);
460 1.1 itojun return;
461 1.1 itojun }
462 1.1 itojun
463 1.1 itojun #ifdef OLDRAWSOCKET
464 1.1 itojun if (i < sizeof(struct ip6_hdr) + sizeof(struct icmp6_hdr)) {
465 1.1 itojun syslog(LOG_ERR,
466 1.1 itojun "<%s> packet size(%d) is too short",
467 1.1 itojun __FUNCTION__, i);
468 1.1 itojun return;
469 1.1 itojun }
470 1.1 itojun
471 1.1 itojun ip = (struct ip6_hdr *)rcvmhdr.msg_iov[0].iov_base;
472 1.1 itojun icp = (struct icmp6_hdr *)(ip + 1); /* XXX: ext. hdr? */
473 1.1 itojun #else
474 1.1 itojun if (i < sizeof(struct icmp6_hdr)) {
475 1.1 itojun syslog(LOG_ERR,
476 1.1 itojun "<%s> packet size(%d) is too short",
477 1.1 itojun __FUNCTION__, i);
478 1.1 itojun return;
479 1.1 itojun }
480 1.1 itojun
481 1.1 itojun icp = (struct icmp6_hdr *)rcvmhdr.msg_iov[0].iov_base;
482 1.1 itojun #endif
483 1.1 itojun
484 1.1 itojun switch(icp->icmp6_type) {
485 1.1 itojun case ND_ROUTER_SOLICIT:
486 1.1 itojun /* hop limit verification - RFC-2461 6.1.1 */
487 1.1 itojun if (*hlimp != 255) {
488 1.1 itojun syslog(LOG_NOTICE,
489 1.1 itojun "<%s> invalid hop limit(%d) "
490 1.1 itojun "received from %s on %s",
491 1.1 itojun __FUNCTION__, *hlimp,
492 1.1 itojun inet_ntop(AF_INET6, &from.sin6_addr, ntopbuf,
493 1.1 itojun INET6_ADDRSTRLEN),
494 1.1 itojun if_indextoname(pi->ipi6_ifindex, ifnamebuf));
495 1.1 itojun return;
496 1.1 itojun }
497 1.1 itojun rs_input(i, (struct nd_router_solicit *)icp, pi, &from);
498 1.1 itojun break;
499 1.1 itojun case ND_ROUTER_ADVERT:
500 1.1 itojun /* hop limit verification - RFC-2461 6.1.1 */
501 1.1 itojun if (*hlimp != 255) {
502 1.1 itojun syslog(LOG_NOTICE,
503 1.1 itojun "<%s> invalid hop limit(%d) "
504 1.1 itojun "received from %s on %s",
505 1.1 itojun __FUNCTION__, *hlimp,
506 1.1 itojun inet_ntop(AF_INET6, &from.sin6_addr, ntopbuf,
507 1.1 itojun INET6_ADDRSTRLEN),
508 1.1 itojun if_indextoname(pi->ipi6_ifindex, ifnamebuf));
509 1.1 itojun return;
510 1.1 itojun }
511 1.1 itojun ra_input(i, (struct nd_router_advert *)icp, pi, &from);
512 1.1 itojun break;
513 1.1 itojun case ICMP6_ROUTER_RENUMBERING:
514 1.1 itojun if (accept_rr == 0) {
515 1.1 itojun syslog(LOG_ERR,
516 1.1 itojun "<%s> received a router renumbering "
517 1.1 itojun "message, but not allowed to be accepted",
518 1.1 itojun __FUNCTION__);
519 1.1 itojun break;
520 1.1 itojun }
521 1.1 itojun rr_input(i, (struct icmp6_router_renum *)icp, pi, &from,
522 1.1 itojun &dst);
523 1.1 itojun break;
524 1.1 itojun default:
525 1.1 itojun /*
526 1.1 itojun * Note that this case is POSSIBLE, especially just
527 1.1 itojun * after invocation of the daemon. This is because we
528 1.1 itojun * could receive message after opening the socket and
529 1.1 itojun * before setting ICMP6 type filter(see sock_open()).
530 1.1 itojun */
531 1.1 itojun syslog(LOG_ERR,
532 1.1 itojun "<%s> invalid icmp type(%d)",
533 1.1 itojun __FUNCTION__, icp->icmp6_type);
534 1.1 itojun return;
535 1.1 itojun }
536 1.1 itojun
537 1.1 itojun return;
538 1.1 itojun }
539 1.1 itojun
540 1.1 itojun static void
541 1.1 itojun rs_input(int len, struct nd_router_solicit *rs,
542 1.1 itojun struct in6_pktinfo *pi, struct sockaddr_in6 *from)
543 1.1 itojun {
544 1.1 itojun u_char ntopbuf[INET6_ADDRSTRLEN], ifnamebuf[IFNAMSIZ];
545 1.1 itojun union nd_opts ndopts;
546 1.1 itojun struct rainfo *ra;
547 1.1 itojun
548 1.1 itojun syslog(LOG_DEBUG,
549 1.1 itojun "<%s> RS received from %s on %s",
550 1.1 itojun __FUNCTION__,
551 1.1 itojun inet_ntop(AF_INET6, &from->sin6_addr,
552 1.1 itojun ntopbuf, INET6_ADDRSTRLEN),
553 1.1 itojun if_indextoname(pi->ipi6_ifindex, ifnamebuf));
554 1.1 itojun
555 1.1 itojun /* ND option check */
556 1.1 itojun memset(&ndopts, 0, sizeof(ndopts));
557 1.1 itojun if (nd6_options((struct nd_opt_hdr *)(rs + 1),
558 1.1 itojun len - sizeof(struct nd_router_solicit),
559 1.1 itojun &ndopts, NDOPT_FLAG_SRCLINKADDR)) {
560 1.1 itojun syslog(LOG_DEBUG,
561 1.1 itojun "<%s> ND option check failed for an RS from %s on %s",
562 1.1 itojun __FUNCTION__,
563 1.1 itojun inet_ntop(AF_INET6, &from->sin6_addr,
564 1.1 itojun ntopbuf, INET6_ADDRSTRLEN),
565 1.1 itojun if_indextoname(pi->ipi6_ifindex, ifnamebuf));
566 1.1 itojun return;
567 1.1 itojun }
568 1.1 itojun
569 1.1 itojun /*
570 1.1 itojun * If the IP source address is the unspecified address, there
571 1.1 itojun * must be no source link-layer address option in the message.
572 1.1 itojun * (RFC-2461 6.1.1)
573 1.1 itojun */
574 1.1 itojun if (IN6_IS_ADDR_UNSPECIFIED(&from->sin6_addr) &&
575 1.1 itojun ndopts.nd_opts_src_lladdr) {
576 1.1 itojun syslog(LOG_ERR,
577 1.1 itojun "<%s> RS from unspecified src on %s has a link-layer"
578 1.1 itojun " address option",
579 1.1 itojun __FUNCTION__,
580 1.1 itojun if_indextoname(pi->ipi6_ifindex, ifnamebuf));
581 1.1 itojun goto done;
582 1.1 itojun }
583 1.1 itojun
584 1.1 itojun ra = ralist;
585 1.1 itojun while (ra != NULL) {
586 1.1 itojun if (pi->ipi6_ifindex == ra->ifindex)
587 1.1 itojun break;
588 1.1 itojun ra = ra->next;
589 1.1 itojun }
590 1.1 itojun if (ra == NULL) {
591 1.1 itojun syslog(LOG_INFO,
592 1.1 itojun "<%s> RS received on non advertising interface(%s)",
593 1.1 itojun __FUNCTION__,
594 1.1 itojun if_indextoname(pi->ipi6_ifindex, ifnamebuf));
595 1.1 itojun goto done;
596 1.1 itojun }
597 1.1 itojun
598 1.1 itojun /*
599 1.1 itojun * Decide whether to send RA according to the rate-limit
600 1.1 itojun * consideration.
601 1.1 itojun */
602 1.1 itojun {
603 1.1 itojun long delay; /* must not be greater than 1000000 */
604 1.1 itojun struct timeval interval, now, min_delay, tm_tmp, *rest;
605 1.1 itojun
606 1.1 itojun /*
607 1.1 itojun * If there is already a waiting RS packet, don't
608 1.1 itojun * update the timer.
609 1.1 itojun */
610 1.1 itojun if (ra->waiting++)
611 1.1 itojun goto done;
612 1.1 itojun
613 1.1 itojun /*
614 1.1 itojun * Compute a random delay. If the computed value
615 1.1 itojun * corresponds to a time later than the time the next
616 1.1 itojun * multicast RA is scheduled to be sent, ignore the random
617 1.1 itojun * delay and send the advertisement at the
618 1.1 itojun * already-scheduled time. RFC-2461 6.2.6
619 1.1 itojun */
620 1.1 itojun delay = random() % MAX_RA_DELAY_TIME;
621 1.1 itojun interval.tv_sec = 0;
622 1.1 itojun interval.tv_usec = delay;
623 1.1 itojun rest = rtadvd_timer_rest(ra->timer);
624 1.1 itojun if (TIMEVAL_LT(*rest, interval)) {
625 1.1 itojun syslog(LOG_DEBUG,
626 1.1 itojun "<%s> random delay is larger than "
627 1.1 itojun "the rest of normal timer",
628 1.1 itojun __FUNCTION__);
629 1.1 itojun interval = *rest;
630 1.1 itojun }
631 1.1 itojun
632 1.1 itojun /*
633 1.1 itojun * If we sent a multicast Router Advertisement within
634 1.1 itojun * the last MIN_DELAY_BETWEEN_RAS seconds, schedule
635 1.1 itojun * the advertisement to be sent at a time corresponding to
636 1.1 itojun * MIN_DELAY_BETWEEN_RAS plus the random value after the
637 1.1 itojun * previous advertisement was sent.
638 1.1 itojun */
639 1.1 itojun gettimeofday(&now, NULL);
640 1.1 itojun TIMEVAL_SUB(&now, &ra->lastsent, &tm_tmp);
641 1.1 itojun min_delay.tv_sec = MIN_DELAY_BETWEEN_RAS;
642 1.1 itojun min_delay.tv_usec = 0;
643 1.1 itojun if (TIMEVAL_LT(tm_tmp, min_delay)) {
644 1.1 itojun TIMEVAL_SUB(&min_delay, &tm_tmp, &min_delay);
645 1.1 itojun TIMEVAL_ADD(&min_delay, &interval, &interval);
646 1.1 itojun }
647 1.1 itojun rtadvd_set_timer(&interval, ra->timer);
648 1.1 itojun goto done;
649 1.1 itojun }
650 1.1 itojun
651 1.1 itojun done:
652 1.1 itojun free_ndopts(&ndopts);
653 1.1 itojun return;
654 1.1 itojun }
655 1.1 itojun
656 1.1 itojun static void
657 1.1 itojun ra_input(int len, struct nd_router_advert *ra,
658 1.1 itojun struct in6_pktinfo *pi, struct sockaddr_in6 *from)
659 1.1 itojun {
660 1.1 itojun struct rainfo *rai;
661 1.1 itojun u_char ntopbuf[INET6_ADDRSTRLEN], ifnamebuf[IFNAMSIZ];
662 1.1 itojun union nd_opts ndopts;
663 1.1 itojun char *on_off[] = {"OFF", "ON"};
664 1.1 itojun u_int32_t reachabletime, retranstimer, mtu;
665 1.1 itojun
666 1.1 itojun syslog(LOG_DEBUG,
667 1.1 itojun "<%s> RA received from %s on %s",
668 1.1 itojun __FUNCTION__,
669 1.1 itojun inet_ntop(AF_INET6, &from->sin6_addr,
670 1.1 itojun ntopbuf, INET6_ADDRSTRLEN),
671 1.1 itojun if_indextoname(pi->ipi6_ifindex, ifnamebuf));
672 1.1 itojun
673 1.1 itojun /* ND option check */
674 1.1 itojun memset(&ndopts, 0, sizeof(ndopts));
675 1.1 itojun if (nd6_options((struct nd_opt_hdr *)(ra + 1),
676 1.1 itojun len - sizeof(struct nd_router_advert),
677 1.1 itojun &ndopts,
678 1.1 itojun NDOPT_FLAG_PREFIXINFO | NDOPT_FLAG_MTU)) {
679 1.1 itojun syslog(LOG_ERR,
680 1.1 itojun "<%s> ND option check failed for an RA from %s on %s",
681 1.1 itojun __FUNCTION__,
682 1.1 itojun inet_ntop(AF_INET6, &from->sin6_addr,
683 1.1 itojun ntopbuf, INET6_ADDRSTRLEN),
684 1.1 itojun if_indextoname(pi->ipi6_ifindex, ifnamebuf));
685 1.1 itojun return;
686 1.1 itojun }
687 1.1 itojun
688 1.1 itojun /*
689 1.1 itojun * RA consistency check according to RFC-2461 6.2.7
690 1.1 itojun */
691 1.1 itojun if ((rai = if_indextorainfo(pi->ipi6_ifindex)) == 0) {
692 1.1 itojun syslog(LOG_INFO,
693 1.1 itojun "<%s> received RA from %s on non-advertising"
694 1.1 itojun " interface(%s)",
695 1.1 itojun __FUNCTION__,
696 1.1 itojun inet_ntop(AF_INET6, &from->sin6_addr,
697 1.1 itojun ntopbuf, INET6_ADDRSTRLEN),
698 1.1 itojun if_indextoname(pi->ipi6_ifindex, ifnamebuf));
699 1.1 itojun goto done;
700 1.1 itojun }
701 1.1 itojun /* Cur Hop Limit value */
702 1.1 itojun if (ra->nd_ra_curhoplimit && rai->hoplimit &&
703 1.1 itojun ra->nd_ra_curhoplimit != rai->hoplimit) {
704 1.1 itojun syslog(LOG_WARNING,
705 1.1 itojun "<%s> CurHopLimit inconsistent on %s:"
706 1.1 itojun " %d from %s, %d from us",
707 1.1 itojun __FUNCTION__,
708 1.1 itojun rai->ifname,
709 1.1 itojun ra->nd_ra_curhoplimit,
710 1.1 itojun inet_ntop(AF_INET6, &from->sin6_addr,
711 1.1 itojun ntopbuf, INET6_ADDRSTRLEN),
712 1.1 itojun rai->hoplimit);
713 1.1 itojun }
714 1.1 itojun /* M flag */
715 1.1 itojun if ((ra->nd_ra_flags_reserved & ND_RA_FLAG_MANAGED) !=
716 1.1 itojun rai->managedflg) {
717 1.1 itojun syslog(LOG_WARNING,
718 1.1 itojun "<%s> M flag inconsistent on %s:"
719 1.1 itojun " %s from %s, %s from us",
720 1.1 itojun __FUNCTION__,
721 1.1 itojun rai->ifname,
722 1.1 itojun on_off[!rai->managedflg],
723 1.1 itojun inet_ntop(AF_INET6, &from->sin6_addr,
724 1.1 itojun ntopbuf, INET6_ADDRSTRLEN),
725 1.1 itojun on_off[rai->managedflg]);
726 1.1 itojun }
727 1.1 itojun /* O flag */
728 1.1 itojun if ((ra->nd_ra_flags_reserved & ND_RA_FLAG_OTHER) !=
729 1.1 itojun rai->otherflg) {
730 1.1 itojun syslog(LOG_WARNING,
731 1.1 itojun "<%s> O flag inconsistent on %s:"
732 1.1 itojun " %s from %s, %s from us",
733 1.1 itojun __FUNCTION__,
734 1.1 itojun rai->ifname,
735 1.1 itojun on_off[!rai->otherflg],
736 1.1 itojun inet_ntop(AF_INET6, &from->sin6_addr,
737 1.1 itojun ntopbuf, INET6_ADDRSTRLEN),
738 1.1 itojun on_off[rai->otherflg]);
739 1.1 itojun }
740 1.1 itojun /* Reachable Time */
741 1.1 itojun reachabletime = ntohl(ra->nd_ra_reachable);
742 1.1 itojun if (reachabletime && rai->reachabletime &&
743 1.1 itojun reachabletime != rai->reachabletime) {
744 1.1 itojun syslog(LOG_WARNING,
745 1.1 itojun "<%s> ReachableTime inconsistent on %s:"
746 1.1 itojun " %d from %s, %d from us",
747 1.1 itojun __FUNCTION__,
748 1.1 itojun rai->ifname,
749 1.1 itojun reachabletime,
750 1.1 itojun inet_ntop(AF_INET6, &from->sin6_addr,
751 1.1 itojun ntopbuf, INET6_ADDRSTRLEN),
752 1.1 itojun rai->reachabletime);
753 1.1 itojun }
754 1.1 itojun /* Retrans Timer */
755 1.1 itojun retranstimer = ntohl(ra->nd_ra_retransmit);
756 1.1 itojun if (retranstimer && rai->retranstimer &&
757 1.1 itojun retranstimer != rai->retranstimer) {
758 1.1 itojun syslog(LOG_WARNING,
759 1.1 itojun "<%s> RetranceTimer inconsistent on %s:"
760 1.1 itojun " %d from %s, %d from us",
761 1.1 itojun __FUNCTION__,
762 1.1 itojun rai->ifname,
763 1.1 itojun retranstimer,
764 1.1 itojun inet_ntop(AF_INET6, &from->sin6_addr,
765 1.1 itojun ntopbuf, INET6_ADDRSTRLEN),
766 1.1 itojun rai->retranstimer);
767 1.1 itojun }
768 1.1 itojun /* Values in the MTU options */
769 1.1 itojun if (ndopts.nd_opts_mtu) {
770 1.1 itojun mtu = ntohl(ndopts.nd_opts_mtu->nd_opt_mtu_mtu);
771 1.1 itojun if (mtu && rai->linkmtu && mtu != rai->linkmtu) {
772 1.1 itojun syslog(LOG_WARNING,
773 1.1 itojun "<%s> MTU option value inconsistent on %s:"
774 1.1 itojun " %d from %s, %d from us",
775 1.1 itojun __FUNCTION__,
776 1.1 itojun rai->ifname, mtu,
777 1.1 itojun inet_ntop(AF_INET6, &from->sin6_addr,
778 1.1 itojun ntopbuf, INET6_ADDRSTRLEN),
779 1.1 itojun rai->linkmtu);
780 1.1 itojun }
781 1.1 itojun }
782 1.1 itojun /* Preferred and Valid Lifetimes for prefixes */
783 1.1 itojun {
784 1.1 itojun struct nd_optlist *optp = ndopts.nd_opts_list;
785 1.1 itojun
786 1.1 itojun if (ndopts.nd_opts_pi)
787 1.1 itojun prefix_check(ndopts.nd_opts_pi, rai, from);
788 1.1 itojun while (optp) {
789 1.1 itojun prefix_check((struct nd_opt_prefix_info *)optp->opt,
790 1.1 itojun rai, from);
791 1.1 itojun optp = optp->next;
792 1.1 itojun }
793 1.1 itojun }
794 1.1 itojun
795 1.1 itojun done:
796 1.1 itojun free_ndopts(&ndopts);
797 1.1 itojun return;
798 1.1 itojun }
799 1.1 itojun
800 1.1 itojun static void
801 1.1 itojun prefix_check(struct nd_opt_prefix_info *pinfo,
802 1.1 itojun struct rainfo *rai, struct sockaddr_in6 *from)
803 1.1 itojun {
804 1.1 itojun u_int32_t preferred_time, valid_time;
805 1.1 itojun struct prefix *pp;
806 1.1 itojun u_char ntopbuf[INET6_ADDRSTRLEN], prefixbuf[INET6_ADDRSTRLEN];
807 1.1 itojun
808 1.1 itojun #if 0 /* impossible */
809 1.1 itojun if (pinfo->nd_opt_pi_type != ND_OPT_PREFIX_INFORMATION)
810 1.1 itojun return;
811 1.1 itojun #endif
812 1.1 itojun
813 1.1 itojun /*
814 1.1 itojun * log if the adveritsed prefix has link-local scope(sanity check?)
815 1.1 itojun */
816 1.1 itojun if (IN6_IS_ADDR_LINKLOCAL(&pinfo->nd_opt_pi_prefix)) {
817 1.1 itojun syslog(LOG_INFO,
818 1.1 itojun "<%s> link-local prefix %s/%d is advertised "
819 1.1 itojun "from %s on %s",
820 1.1 itojun __FUNCTION__,
821 1.1 itojun inet_ntop(AF_INET6, &pinfo->nd_opt_pi_prefix,
822 1.1 itojun prefixbuf, INET6_ADDRSTRLEN),
823 1.1 itojun pinfo->nd_opt_pi_prefix_len,
824 1.1 itojun inet_ntop(AF_INET6, &from->sin6_addr,
825 1.1 itojun ntopbuf, INET6_ADDRSTRLEN),
826 1.1 itojun rai->ifname);
827 1.1 itojun }
828 1.1 itojun
829 1.1 itojun if ((pp = find_prefix(rai, &pinfo->nd_opt_pi_prefix,
830 1.1 itojun pinfo->nd_opt_pi_prefix_len)) == NULL) {
831 1.1 itojun syslog(LOG_INFO,
832 1.1 itojun "<%s> prefix %s/%d from %s on %s is not in our list",
833 1.1 itojun __FUNCTION__,
834 1.1 itojun inet_ntop(AF_INET6, &pinfo->nd_opt_pi_prefix,
835 1.1 itojun prefixbuf, INET6_ADDRSTRLEN),
836 1.1 itojun pinfo->nd_opt_pi_prefix_len,
837 1.1 itojun inet_ntop(AF_INET6, &from->sin6_addr,
838 1.1 itojun ntopbuf, INET6_ADDRSTRLEN),
839 1.1 itojun rai->ifname);
840 1.1 itojun return;
841 1.1 itojun }
842 1.1 itojun
843 1.1 itojun preferred_time = ntohl(pinfo->nd_opt_pi_preferred_time);
844 1.1 itojun if (preferred_time != pp->preflifetime)
845 1.1 itojun syslog(LOG_WARNING,
846 1.1 itojun "<%s> prefeerred lifetime for %s/%d"
847 1.1 itojun " inconsistent on %s:"
848 1.1 itojun " %d from %s, %d from us",
849 1.1 itojun __FUNCTION__,
850 1.1 itojun inet_ntop(AF_INET6, &pinfo->nd_opt_pi_prefix,
851 1.1 itojun prefixbuf, INET6_ADDRSTRLEN),
852 1.1 itojun pinfo->nd_opt_pi_prefix_len,
853 1.1 itojun rai->ifname, preferred_time,
854 1.1 itojun inet_ntop(AF_INET6, &from->sin6_addr,
855 1.1 itojun ntopbuf, INET6_ADDRSTRLEN),
856 1.1 itojun pp->preflifetime);
857 1.1 itojun
858 1.1 itojun valid_time = ntohl(pinfo->nd_opt_pi_valid_time);
859 1.1 itojun if (valid_time != pp->validlifetime)
860 1.1 itojun syslog(LOG_WARNING,
861 1.1 itojun "<%s> valid lifetime for %s/%d"
862 1.1 itojun " inconsistent on %s:"
863 1.1 itojun " %d from %s, %d from us",
864 1.1 itojun __FUNCTION__,
865 1.1 itojun inet_ntop(AF_INET6, &pinfo->nd_opt_pi_prefix,
866 1.1 itojun prefixbuf, INET6_ADDRSTRLEN),
867 1.1 itojun pinfo->nd_opt_pi_prefix_len,
868 1.1 itojun rai->ifname, valid_time,
869 1.1 itojun inet_ntop(AF_INET6, &from->sin6_addr,
870 1.1 itojun ntopbuf, INET6_ADDRSTRLEN),
871 1.1 itojun pp->validlifetime);
872 1.1 itojun }
873 1.1 itojun
874 1.1 itojun struct prefix *
875 1.1 itojun find_prefix(struct rainfo *rai, struct in6_addr *prefix, int plen)
876 1.1 itojun {
877 1.1 itojun struct prefix *pp;
878 1.1 itojun int bytelen, bitlen;
879 1.1 itojun
880 1.1 itojun for (pp = rai->prefix.next; pp != &rai->prefix; pp = pp->next) {
881 1.1 itojun if (plen != pp->prefixlen)
882 1.1 itojun continue;
883 1.1 itojun bytelen = plen / 8;
884 1.1 itojun bitlen = plen % 8;
885 1.1 itojun if (memcmp((void *)prefix, (void *)&pp->prefix, bytelen))
886 1.1 itojun continue;
887 1.1 itojun if (prefix->s6_addr[bytelen] >> (8 - bitlen) ==
888 1.1 itojun pp->prefix.s6_addr[bytelen] >> (8 - bitlen))
889 1.1 itojun return(pp);
890 1.1 itojun }
891 1.1 itojun
892 1.1 itojun return(NULL);
893 1.1 itojun }
894 1.1 itojun
895 1.1 itojun static int
896 1.1 itojun nd6_options(struct nd_opt_hdr *hdr, int limit,
897 1.1 itojun union nd_opts *ndopts, u_int32_t optflags)
898 1.1 itojun {
899 1.1 itojun int optlen = 0;
900 1.1 itojun
901 1.1 itojun for (; limit > 0; limit -= optlen) {
902 1.1 itojun hdr = (struct nd_opt_hdr *)((caddr_t)hdr + optlen);
903 1.1 itojun optlen = hdr->nd_opt_len << 3;
904 1.1 itojun if (hdr->nd_opt_len == 0) {
905 1.1 itojun syslog(LOG_ERR,
906 1.1 itojun "<%s> bad ND option length(0) (type = %d)",
907 1.1 itojun __FUNCTION__, hdr->nd_opt_type);
908 1.1 itojun goto bad;
909 1.1 itojun }
910 1.1 itojun
911 1.1 itojun if (hdr->nd_opt_type > ND_OPT_MTU) {
912 1.1 itojun syslog(LOG_INFO,
913 1.1 itojun "<%s> unknown ND option(type %d)",
914 1.1 itojun __FUNCTION__,
915 1.1 itojun hdr->nd_opt_type);
916 1.1 itojun continue;
917 1.1 itojun }
918 1.1 itojun
919 1.1 itojun if ((ndopt_flags[hdr->nd_opt_type] & optflags) == 0) {
920 1.1 itojun syslog(LOG_INFO,
921 1.1 itojun "<%s> unexpected ND option(type %d)",
922 1.1 itojun __FUNCTION__,
923 1.1 itojun hdr->nd_opt_type);
924 1.1 itojun continue;
925 1.1 itojun }
926 1.1 itojun
927 1.1 itojun switch(hdr->nd_opt_type) {
928 1.1 itojun case ND_OPT_SOURCE_LINKADDR:
929 1.1 itojun case ND_OPT_TARGET_LINKADDR:
930 1.1 itojun case ND_OPT_REDIRECTED_HEADER:
931 1.1 itojun case ND_OPT_MTU:
932 1.1 itojun if (ndopts->nd_opt_array[hdr->nd_opt_type]) {
933 1.1 itojun syslog(LOG_INFO,
934 1.1 itojun "<%s> duplicated ND option"
935 1.1 itojun " (type = %d)",
936 1.1 itojun __FUNCTION__,
937 1.1 itojun hdr->nd_opt_type);
938 1.1 itojun }
939 1.1 itojun ndopts->nd_opt_array[hdr->nd_opt_type] = hdr;
940 1.1 itojun break;
941 1.1 itojun case ND_OPT_PREFIX_INFORMATION:
942 1.1 itojun {
943 1.1 itojun struct nd_optlist *pfxlist;
944 1.1 itojun
945 1.1 itojun if (ndopts->nd_opts_pi == 0) {
946 1.1 itojun ndopts->nd_opts_pi =
947 1.1 itojun (struct nd_opt_prefix_info *)hdr;
948 1.1 itojun continue;
949 1.1 itojun }
950 1.1 itojun if ((pfxlist = malloc(sizeof(*pfxlist))) == NULL) {
951 1.1 itojun syslog(LOG_ERR,
952 1.1 itojun "<%s> can't allocate memory",
953 1.1 itojun __FUNCTION__);
954 1.1 itojun goto bad;
955 1.1 itojun }
956 1.1 itojun pfxlist->next = ndopts->nd_opts_list;
957 1.1 itojun pfxlist->opt = hdr;
958 1.1 itojun ndopts->nd_opts_list = pfxlist;
959 1.1 itojun
960 1.1 itojun break;
961 1.1 itojun }
962 1.1 itojun default: /* impossible */
963 1.1 itojun break;
964 1.1 itojun }
965 1.1 itojun }
966 1.1 itojun
967 1.1 itojun return(0);
968 1.1 itojun
969 1.1 itojun bad:
970 1.1 itojun free_ndopts(ndopts);
971 1.1 itojun
972 1.1 itojun return(-1);
973 1.1 itojun }
974 1.1 itojun
975 1.1 itojun static void
976 1.1 itojun free_ndopts(union nd_opts *ndopts)
977 1.1 itojun {
978 1.1 itojun struct nd_optlist *opt = ndopts->nd_opts_list, *next;
979 1.1 itojun
980 1.1 itojun while(opt) {
981 1.1 itojun next = opt->next;
982 1.1 itojun free(opt);
983 1.1 itojun opt = next;
984 1.1 itojun }
985 1.1 itojun }
986 1.1 itojun
987 1.1 itojun void
988 1.1 itojun sock_open()
989 1.1 itojun {
990 1.1 itojun struct icmp6_filter filt;
991 1.1 itojun struct ipv6_mreq mreq;
992 1.1 itojun struct rainfo *ra = ralist;
993 1.1 itojun int on;
994 1.1 itojun /* XXX: should be max MTU attached to the node */
995 1.1 itojun static u_char answer[1500];
996 1.1 itojun static u_char sndcmsgbuf[CMSG_SPACE(sizeof(struct in6_pktinfo)) +
997 1.1 itojun CMSG_SPACE(sizeof(int))];
998 1.1 itojun
999 1.1 itojun if ((sock = socket(AF_INET6, SOCK_RAW, IPPROTO_ICMPV6)) < 0) {
1000 1.1 itojun syslog(LOG_ERR, "<%s> socket: %s", __FUNCTION__,
1001 1.1 itojun strerror(errno));
1002 1.1 itojun exit(1);
1003 1.1 itojun }
1004 1.1 itojun
1005 1.1 itojun /* specify to tell receiving interface */
1006 1.1 itojun on = 1;
1007 1.1 itojun if (setsockopt(sock, IPPROTO_IPV6, IPV6_PKTINFO, &on,
1008 1.1 itojun sizeof(on)) < 0) {
1009 1.1 itojun syslog(LOG_ERR, "<%s> IPV6_PKTINFO: %s",
1010 1.1 itojun __FUNCTION__, strerror(errno));
1011 1.1 itojun exit(1);
1012 1.1 itojun }
1013 1.1 itojun
1014 1.1 itojun on = 1;
1015 1.1 itojun /* specify to tell value of hoplimit field of received IP6 hdr */
1016 1.1 itojun if (setsockopt(sock, IPPROTO_IPV6, IPV6_HOPLIMIT, &on,
1017 1.1 itojun sizeof(on)) < 0) {
1018 1.1 itojun syslog(LOG_ERR, "<%s> IPV6_HOPLIMIT: %s",
1019 1.1 itojun __FUNCTION__, strerror(errno));
1020 1.1 itojun exit(1);
1021 1.1 itojun }
1022 1.1 itojun
1023 1.1 itojun ICMP6_FILTER_SETBLOCKALL(&filt);
1024 1.1 itojun ICMP6_FILTER_SETPASS(ND_ROUTER_SOLICIT, &filt);
1025 1.1 itojun ICMP6_FILTER_SETPASS(ND_ROUTER_ADVERT, &filt);
1026 1.1 itojun if (accept_rr)
1027 1.1 itojun ICMP6_FILTER_SETPASS(ICMP6_ROUTER_RENUMBERING, &filt);
1028 1.1 itojun if (setsockopt(sock, IPPROTO_ICMPV6, ICMP6_FILTER, &filt,
1029 1.1 itojun sizeof(filt)) < 0) {
1030 1.1 itojun syslog(LOG_ERR, "<%s> IICMP6_FILTER: %s",
1031 1.1 itojun __FUNCTION__, strerror(errno));
1032 1.1 itojun exit(1);
1033 1.1 itojun }
1034 1.1 itojun
1035 1.1 itojun /*
1036 1.1 itojun * join all routers multicast address on each advertising interface.
1037 1.1 itojun */
1038 1.1 itojun if (inet_pton(AF_INET6, ALLROUTERS, &mreq.ipv6mr_multiaddr.s6_addr)
1039 1.1 itojun != 1) {
1040 1.1 itojun syslog(LOG_ERR, "<%s> inet_pton failed(library bug?)",
1041 1.1 itojun __FUNCTION__);
1042 1.1 itojun exit(1);
1043 1.1 itojun }
1044 1.1 itojun while(ra) {
1045 1.1 itojun mreq.ipv6mr_interface = ra->ifindex;
1046 1.1 itojun if (setsockopt(sock, IPPROTO_IPV6, IPV6_JOIN_GROUP,
1047 1.1 itojun &mreq,
1048 1.1 itojun sizeof(mreq)) < 0) {
1049 1.1 itojun syslog(LOG_ERR, "<%s> IPV6_JOIN_GROUP on %s: %s",
1050 1.1 itojun __FUNCTION__, ra->ifname, strerror(errno));
1051 1.1 itojun exit(1);
1052 1.1 itojun }
1053 1.1 itojun ra = ra->next;
1054 1.1 itojun }
1055 1.1 itojun
1056 1.1 itojun /* initialize msghdr for receiving packets */
1057 1.1 itojun rcviov[0].iov_base = (caddr_t)answer;
1058 1.1 itojun rcviov[0].iov_len = sizeof(answer);
1059 1.1 itojun rcvmhdr.msg_name = (caddr_t)&from;
1060 1.1 itojun rcvmhdr.msg_namelen = sizeof(from);
1061 1.1 itojun rcvmhdr.msg_iov = rcviov;
1062 1.1 itojun rcvmhdr.msg_iovlen = 1;
1063 1.1 itojun rcvmhdr.msg_control = (caddr_t) rcvcmsgbuf;
1064 1.1 itojun rcvmhdr.msg_controllen = sizeof(rcvcmsgbuf);
1065 1.1 itojun
1066 1.1 itojun /* initialize msghdr for sending packets */
1067 1.1 itojun sndmhdr.msg_namelen = sizeof(struct sockaddr_in6);
1068 1.1 itojun sndmhdr.msg_iov = sndiov;
1069 1.1 itojun sndmhdr.msg_iovlen = 1;
1070 1.1 itojun sndmhdr.msg_control = (caddr_t)sndcmsgbuf;
1071 1.1 itojun sndmhdr.msg_controllen = sizeof(sndcmsgbuf);
1072 1.1 itojun
1073 1.1 itojun return;
1074 1.1 itojun }
1075 1.1 itojun
1076 1.1 itojun /* open a routing socket to watch the routing table */
1077 1.1 itojun static void
1078 1.1 itojun rtsock_open()
1079 1.1 itojun {
1080 1.1 itojun if ((rtsock = socket(PF_ROUTE, SOCK_RAW, 0)) < 0) {
1081 1.1 itojun syslog(LOG_ERR,
1082 1.1 itojun "<%s> socket: %s", __FUNCTION__, strerror(errno));
1083 1.1 itojun exit(1);
1084 1.1 itojun }
1085 1.1 itojun }
1086 1.1 itojun
1087 1.1 itojun static struct rainfo *
1088 1.1 itojun if_indextorainfo(int index)
1089 1.1 itojun {
1090 1.1 itojun struct rainfo *rai = ralist;
1091 1.1 itojun
1092 1.1 itojun for (rai = ralist; rai; rai = rai->next) {
1093 1.1 itojun if (rai->ifindex == index)
1094 1.1 itojun return(rai);
1095 1.1 itojun }
1096 1.1 itojun
1097 1.1 itojun return(NULL); /* search failed */
1098 1.1 itojun }
1099 1.1 itojun
1100 1.1 itojun static void
1101 1.1 itojun ra_output(rainfo)
1102 1.1 itojun struct rainfo *rainfo;
1103 1.1 itojun {
1104 1.1 itojun int i;
1105 1.1 itojun
1106 1.1 itojun struct cmsghdr *cm;
1107 1.1 itojun struct in6_pktinfo *pi;
1108 1.1 itojun
1109 1.1 itojun sndmhdr.msg_name = (caddr_t)&sin6_allnodes;
1110 1.1 itojun sndmhdr.msg_iov[0].iov_base = (caddr_t)rainfo->ra_data;
1111 1.1 itojun sndmhdr.msg_iov[0].iov_len = rainfo->ra_datalen;
1112 1.1 itojun
1113 1.1 itojun cm = CMSG_FIRSTHDR(&sndmhdr);
1114 1.1 itojun /* specify the outgoing interface */
1115 1.1 itojun cm->cmsg_level = IPPROTO_IPV6;
1116 1.1 itojun cm->cmsg_type = IPV6_PKTINFO;
1117 1.1 itojun cm->cmsg_len = CMSG_LEN(sizeof(struct in6_pktinfo));
1118 1.1 itojun pi = (struct in6_pktinfo *)CMSG_DATA(cm);
1119 1.1 itojun memset(&pi->ipi6_addr, 0, sizeof(pi->ipi6_addr)); /*XXX*/
1120 1.1 itojun pi->ipi6_ifindex = rainfo->ifindex;
1121 1.1 itojun
1122 1.1 itojun /* specify the hop limit of the packet */
1123 1.1 itojun {
1124 1.1 itojun int hoplimit = 255;
1125 1.1 itojun
1126 1.1 itojun cm = CMSG_NXTHDR(&sndmhdr, cm);
1127 1.1 itojun cm->cmsg_level = IPPROTO_IPV6;
1128 1.1 itojun cm->cmsg_type = IPV6_HOPLIMIT;
1129 1.1 itojun cm->cmsg_len = CMSG_LEN(sizeof(int));
1130 1.1 itojun memcpy(CMSG_DATA(cm), &hoplimit, sizeof(int));
1131 1.1 itojun }
1132 1.1 itojun
1133 1.1 itojun syslog(LOG_DEBUG,
1134 1.1 itojun "<%s> send RA on %s, # of waitings = %d",
1135 1.1 itojun __FUNCTION__, rainfo->ifname, rainfo->waiting);
1136 1.1 itojun
1137 1.1 itojun i = sendmsg(sock, &sndmhdr, 0);
1138 1.1 itojun
1139 1.1 itojun if (i < 0 || i != rainfo->ra_datalen) {
1140 1.1 itojun if (i < 0) {
1141 1.1 itojun syslog(LOG_ERR, "<%s> sendmsg: %s",
1142 1.1 itojun __FUNCTION__, strerror(errno));
1143 1.1 itojun }
1144 1.1 itojun }
1145 1.1 itojun
1146 1.1 itojun /* update counter */
1147 1.1 itojun if (rainfo->initcounter < MAX_INITIAL_RTR_ADVERTISEMENTS)
1148 1.1 itojun rainfo->initcounter++;
1149 1.1 itojun
1150 1.1 itojun /* update timestamp */
1151 1.1 itojun gettimeofday(&rainfo->lastsent, NULL);
1152 1.1 itojun
1153 1.1 itojun /* reset waiting conter */
1154 1.1 itojun rainfo->waiting = 0;
1155 1.1 itojun }
1156 1.1 itojun
1157 1.1 itojun /* process RA timer */
1158 1.1 itojun void
1159 1.1 itojun ra_timeout(void *data)
1160 1.1 itojun {
1161 1.1 itojun struct rainfo *rai = (struct rainfo *)data;
1162 1.1 itojun
1163 1.1 itojun #ifdef notyet
1164 1.1 itojun /* if necessary, reconstruct the packet. */
1165 1.1 itojun #endif
1166 1.1 itojun
1167 1.1 itojun syslog(LOG_DEBUG,
1168 1.1 itojun "<%s> RA timer on %s is expired",
1169 1.1 itojun __FUNCTION__, rai->ifname);
1170 1.1 itojun
1171 1.1 itojun if (iflist[rai->ifindex]->ifm_flags & IFF_UP)
1172 1.1 itojun ra_output(rai);
1173 1.1 itojun else
1174 1.1 itojun syslog(LOG_DEBUG, "<%s> %s is not up, skip sending RA",
1175 1.1 itojun __FUNCTION__, rai->ifname);
1176 1.1 itojun }
1177 1.1 itojun
1178 1.1 itojun /* update RA timer */
1179 1.1 itojun void
1180 1.1 itojun ra_timer_update(void *data, struct timeval *tm)
1181 1.1 itojun {
1182 1.1 itojun struct rainfo *rai = (struct rainfo *)data;
1183 1.1 itojun long interval;
1184 1.1 itojun
1185 1.1 itojun /*
1186 1.1 itojun * Whenever a multicast advertisement is sent from an interface,
1187 1.1 itojun * the timer is reset to a uniformly-distributed random value
1188 1.1 itojun * between the interface's configured MinRtrAdvInterval and
1189 1.1 itojun * MaxRtrAdvInterval(discovery-v2-02 6.2.4).
1190 1.1 itojun */
1191 1.1 itojun interval = rai->mininterval;
1192 1.1 itojun interval += random() % (rai->maxinterval - rai->mininterval);
1193 1.1 itojun
1194 1.1 itojun /*
1195 1.1 itojun * For the first few advertisements (up to
1196 1.1 itojun * MAX_INITIAL_RTR_ADVERTISEMENTS), if the randomly chosen interval
1197 1.1 itojun * is greater than MAX_INITIAL_RTR_ADVERT_INTERVAL, the timer
1198 1.1 itojun * SHOULD be set to MAX_INITIAL_RTR_ADVERT_INTERVAL instead.
1199 1.1 itojun * (RFC-2461 6.2.4)
1200 1.1 itojun */
1201 1.1 itojun if (rai->initcounter < MAX_INITIAL_RTR_ADVERTISEMENTS &&
1202 1.1 itojun interval > MAX_INITIAL_RTR_ADVERT_INTERVAL)
1203 1.1 itojun interval = MAX_INITIAL_RTR_ADVERT_INTERVAL;
1204 1.1 itojun
1205 1.1 itojun tm->tv_sec = interval;
1206 1.1 itojun tm->tv_usec = 0;
1207 1.1 itojun
1208 1.1 itojun syslog(LOG_DEBUG,
1209 1.1 itojun "<%s> RA timer on %s is set to %ld:%ld",
1210 1.1 itojun __FUNCTION__, rai->ifname, tm->tv_sec, tm->tv_usec);
1211 1.1 itojun
1212 1.1 itojun return;
1213 1.1 itojun }
1214