icmp6.c revision 1.52 1 1.52 itojun /* $NetBSD: icmp6.c,v 1.52 2001/01/24 09:04:16 itojun Exp $ */
2 1.49 itojun /* $KAME: icmp6.c,v 1.172 2000/12/11 19:27:06 itojun Exp $ */
3 1.3 thorpej
4 1.2 itojun /*
5 1.2 itojun * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project.
6 1.2 itojun * All rights reserved.
7 1.29 itojun *
8 1.2 itojun * Redistribution and use in source and binary forms, with or without
9 1.2 itojun * modification, are permitted provided that the following conditions
10 1.2 itojun * are met:
11 1.2 itojun * 1. Redistributions of source code must retain the above copyright
12 1.2 itojun * notice, this list of conditions and the following disclaimer.
13 1.2 itojun * 2. Redistributions in binary form must reproduce the above copyright
14 1.2 itojun * notice, this list of conditions and the following disclaimer in the
15 1.2 itojun * documentation and/or other materials provided with the distribution.
16 1.2 itojun * 3. Neither the name of the project nor the names of its contributors
17 1.2 itojun * may be used to endorse or promote products derived from this software
18 1.2 itojun * without specific prior written permission.
19 1.29 itojun *
20 1.2 itojun * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
21 1.2 itojun * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
22 1.2 itojun * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
23 1.2 itojun * ARE DISCLAIMED. IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
24 1.2 itojun * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
25 1.2 itojun * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
26 1.2 itojun * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
27 1.2 itojun * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
28 1.2 itojun * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
29 1.2 itojun * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
30 1.2 itojun * SUCH DAMAGE.
31 1.2 itojun */
32 1.2 itojun
33 1.2 itojun /*
34 1.2 itojun * Copyright (c) 1982, 1986, 1988, 1993
35 1.2 itojun * The Regents of the University of California. All rights reserved.
36 1.2 itojun *
37 1.2 itojun * Redistribution and use in source and binary forms, with or without
38 1.2 itojun * modification, are permitted provided that the following conditions
39 1.2 itojun * are met:
40 1.2 itojun * 1. Redistributions of source code must retain the above copyright
41 1.2 itojun * notice, this list of conditions and the following disclaimer.
42 1.2 itojun * 2. Redistributions in binary form must reproduce the above copyright
43 1.2 itojun * notice, this list of conditions and the following disclaimer in the
44 1.2 itojun * documentation and/or other materials provided with the distribution.
45 1.2 itojun * 3. All advertising materials mentioning features or use of this software
46 1.2 itojun * must display the following acknowledgement:
47 1.2 itojun * This product includes software developed by the University of
48 1.2 itojun * California, Berkeley and its contributors.
49 1.2 itojun * 4. Neither the name of the University nor the names of its contributors
50 1.2 itojun * may be used to endorse or promote products derived from this software
51 1.2 itojun * without specific prior written permission.
52 1.2 itojun *
53 1.2 itojun * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
54 1.2 itojun * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
55 1.2 itojun * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
56 1.2 itojun * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
57 1.2 itojun * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
58 1.2 itojun * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
59 1.2 itojun * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
60 1.2 itojun * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
61 1.2 itojun * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
62 1.2 itojun * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
63 1.2 itojun * SUCH DAMAGE.
64 1.2 itojun *
65 1.2 itojun * @(#)ip_icmp.c 8.2 (Berkeley) 1/4/94
66 1.2 itojun */
67 1.2 itojun
68 1.2 itojun #include "opt_inet.h"
69 1.6 thorpej #include "opt_ipsec.h"
70 1.2 itojun
71 1.2 itojun #include <sys/param.h>
72 1.2 itojun #include <sys/systm.h>
73 1.2 itojun #include <sys/malloc.h>
74 1.2 itojun #include <sys/mbuf.h>
75 1.2 itojun #include <sys/protosw.h>
76 1.2 itojun #include <sys/socket.h>
77 1.2 itojun #include <sys/socketvar.h>
78 1.2 itojun #include <sys/time.h>
79 1.2 itojun #include <sys/kernel.h>
80 1.2 itojun #include <sys/syslog.h>
81 1.12 itojun #include <sys/domain.h>
82 1.2 itojun
83 1.2 itojun #include <net/if.h>
84 1.2 itojun #include <net/route.h>
85 1.2 itojun #include <net/if_dl.h>
86 1.2 itojun #include <net/if_types.h>
87 1.2 itojun
88 1.2 itojun #include <netinet/in.h>
89 1.2 itojun #include <netinet/in_var.h>
90 1.19 itojun #include <netinet/ip6.h>
91 1.2 itojun #include <netinet6/ip6_var.h>
92 1.19 itojun #include <netinet/icmp6.h>
93 1.2 itojun #include <netinet6/mld6_var.h>
94 1.2 itojun #include <netinet6/in6_pcb.h>
95 1.2 itojun #include <netinet6/nd6.h>
96 1.2 itojun #include <netinet6/in6_ifattach.h>
97 1.10 itojun #include <netinet6/ip6protosw.h>
98 1.2 itojun
99 1.12 itojun
100 1.2 itojun #ifdef IPSEC
101 1.12 itojun #include <netinet6/ipsec.h>
102 1.2 itojun #include <netkey/key.h>
103 1.2 itojun #endif
104 1.2 itojun
105 1.2 itojun #include "faith.h"
106 1.2 itojun
107 1.12 itojun #include <net/net_osdep.h>
108 1.12 itojun
109 1.12 itojun extern struct domain inet6domain;
110 1.2 itojun
111 1.2 itojun struct icmp6stat icmp6stat;
112 1.2 itojun
113 1.2 itojun extern struct in6pcb rawin6pcb;
114 1.35 itojun extern int icmp6errppslim;
115 1.35 itojun static int icmp6errpps_count = 0;
116 1.37 itojun static struct timeval icmp6errppslim_last;
117 1.14 itojun extern int icmp6_nodeinfo;
118 1.46 itojun
119 1.46 itojun /*
120 1.46 itojun * List of callbacks to notify when Path MTU changes are made.
121 1.46 itojun */
122 1.46 itojun struct icmp6_mtudisc_callback {
123 1.46 itojun LIST_ENTRY(icmp6_mtudisc_callback) mc_list;
124 1.46 itojun void (*mc_func) __P((struct in6_addr *));
125 1.46 itojun };
126 1.46 itojun
127 1.46 itojun LIST_HEAD(, icmp6_mtudisc_callback) icmp6_mtudisc_callbacks =
128 1.46 itojun LIST_HEAD_INITIALIZER(&icmp6_mtudisc_callbacks);
129 1.46 itojun
130 1.8 itojun static struct rttimer_queue *icmp6_mtudisc_timeout_q = NULL;
131 1.8 itojun extern int pmtu_expire;
132 1.8 itojun
133 1.48 itojun /* XXX do these values make any sense? */
134 1.48 itojun int icmp6_mtudisc_hiwat = 1280;
135 1.48 itojun int icmp6_mtudisc_lowat = 256;
136 1.48 itojun
137 1.35 itojun static void icmp6_errcount __P((struct icmp6errstat *, int, int));
138 1.2 itojun static int icmp6_rip6_input __P((struct mbuf **, int));
139 1.2 itojun static int icmp6_ratelimit __P((const struct in6_addr *, const int, const int));
140 1.12 itojun static const char *icmp6_redirect_diag __P((struct in6_addr *,
141 1.12 itojun struct in6_addr *, struct in6_addr *));
142 1.31 itojun static struct mbuf *ni6_input __P((struct mbuf *, int));
143 1.31 itojun static struct mbuf *ni6_nametodns __P((const char *, int, int));
144 1.31 itojun static int ni6_dnsmatch __P((const char *, int, const char *, int));
145 1.2 itojun static int ni6_addrs __P((struct icmp6_nodeinfo *, struct mbuf *,
146 1.47 itojun struct ifnet **, char *));
147 1.2 itojun static int ni6_store_addrs __P((struct icmp6_nodeinfo *, struct icmp6_nodeinfo *,
148 1.2 itojun struct ifnet *, int));
149 1.8 itojun static struct rtentry *icmp6_mtudisc_clone __P((struct sockaddr *));
150 1.8 itojun static void icmp6_mtudisc_timeout __P((struct rtentry *, struct rttimer *));
151 1.2 itojun
152 1.2 itojun #ifdef COMPAT_RFC1885
153 1.2 itojun static struct route_in6 icmp6_reflect_rt;
154 1.29 itojun #endif
155 1.2 itojun
156 1.2 itojun void
157 1.2 itojun icmp6_init()
158 1.2 itojun {
159 1.2 itojun mld6_init();
160 1.8 itojun icmp6_mtudisc_timeout_q = rt_timer_queue_create(pmtu_expire);
161 1.2 itojun }
162 1.2 itojun
163 1.35 itojun static void
164 1.35 itojun icmp6_errcount(stat, type, code)
165 1.35 itojun struct icmp6errstat *stat;
166 1.35 itojun int type, code;
167 1.35 itojun {
168 1.35 itojun switch(type) {
169 1.35 itojun case ICMP6_DST_UNREACH:
170 1.35 itojun switch (code) {
171 1.35 itojun case ICMP6_DST_UNREACH_NOROUTE:
172 1.35 itojun stat->icp6errs_dst_unreach_noroute++;
173 1.35 itojun return;
174 1.35 itojun case ICMP6_DST_UNREACH_ADMIN:
175 1.35 itojun stat->icp6errs_dst_unreach_admin++;
176 1.35 itojun return;
177 1.35 itojun case ICMP6_DST_UNREACH_BEYONDSCOPE:
178 1.35 itojun stat->icp6errs_dst_unreach_beyondscope++;
179 1.35 itojun return;
180 1.35 itojun case ICMP6_DST_UNREACH_ADDR:
181 1.35 itojun stat->icp6errs_dst_unreach_addr++;
182 1.35 itojun return;
183 1.35 itojun case ICMP6_DST_UNREACH_NOPORT:
184 1.35 itojun stat->icp6errs_dst_unreach_noport++;
185 1.35 itojun return;
186 1.35 itojun }
187 1.35 itojun break;
188 1.35 itojun case ICMP6_PACKET_TOO_BIG:
189 1.35 itojun stat->icp6errs_packet_too_big++;
190 1.35 itojun return;
191 1.35 itojun case ICMP6_TIME_EXCEEDED:
192 1.35 itojun switch(code) {
193 1.35 itojun case ICMP6_TIME_EXCEED_TRANSIT:
194 1.35 itojun stat->icp6errs_time_exceed_transit++;
195 1.35 itojun return;
196 1.35 itojun case ICMP6_TIME_EXCEED_REASSEMBLY:
197 1.35 itojun stat->icp6errs_time_exceed_reassembly++;
198 1.35 itojun return;
199 1.35 itojun }
200 1.35 itojun break;
201 1.35 itojun case ICMP6_PARAM_PROB:
202 1.35 itojun switch(code) {
203 1.35 itojun case ICMP6_PARAMPROB_HEADER:
204 1.35 itojun stat->icp6errs_paramprob_header++;
205 1.35 itojun return;
206 1.35 itojun case ICMP6_PARAMPROB_NEXTHEADER:
207 1.35 itojun stat->icp6errs_paramprob_nextheader++;
208 1.35 itojun return;
209 1.35 itojun case ICMP6_PARAMPROB_OPTION:
210 1.35 itojun stat->icp6errs_paramprob_option++;
211 1.35 itojun return;
212 1.35 itojun }
213 1.35 itojun break;
214 1.35 itojun case ND_REDIRECT:
215 1.35 itojun stat->icp6errs_redirect++;
216 1.35 itojun return;
217 1.35 itojun }
218 1.35 itojun stat->icp6errs_unknown++;
219 1.35 itojun }
220 1.35 itojun
221 1.2 itojun /*
222 1.46 itojun * Register a Path MTU Discovery callback.
223 1.46 itojun */
224 1.46 itojun void
225 1.46 itojun icmp6_mtudisc_callback_register(func)
226 1.46 itojun void (*func) __P((struct in6_addr *));
227 1.46 itojun {
228 1.46 itojun struct icmp6_mtudisc_callback *mc;
229 1.46 itojun
230 1.46 itojun for (mc = LIST_FIRST(&icmp6_mtudisc_callbacks); mc != NULL;
231 1.46 itojun mc = LIST_NEXT(mc, mc_list)) {
232 1.46 itojun if (mc->mc_func == func)
233 1.46 itojun return;
234 1.46 itojun }
235 1.46 itojun
236 1.46 itojun mc = malloc(sizeof(*mc), M_PCB, M_NOWAIT);
237 1.46 itojun if (mc == NULL)
238 1.46 itojun panic("icmp6_mtudisc_callback_register");
239 1.46 itojun
240 1.46 itojun mc->mc_func = func;
241 1.46 itojun LIST_INSERT_HEAD(&icmp6_mtudisc_callbacks, mc, mc_list);
242 1.46 itojun }
243 1.46 itojun
244 1.46 itojun /*
245 1.2 itojun * Generate an error packet of type error in response to bad IP6 packet.
246 1.2 itojun */
247 1.2 itojun void
248 1.2 itojun icmp6_error(m, type, code, param)
249 1.2 itojun struct mbuf *m;
250 1.2 itojun int type, code, param;
251 1.2 itojun {
252 1.2 itojun struct ip6_hdr *oip6, *nip6;
253 1.2 itojun struct icmp6_hdr *icmp6;
254 1.17 itohy u_int preplen;
255 1.2 itojun int off;
256 1.27 itojun int nxt;
257 1.2 itojun
258 1.2 itojun icmp6stat.icp6s_error++;
259 1.2 itojun
260 1.35 itojun /* count per-type-code statistics */
261 1.35 itojun icmp6_errcount(&icmp6stat.icp6s_outerrhist, type, code);
262 1.35 itojun
263 1.23 itojun if (m->m_flags & M_DECRYPTED) {
264 1.23 itojun icmp6stat.icp6s_canterror++;
265 1.2 itojun goto freeit;
266 1.23 itojun }
267 1.2 itojun
268 1.12 itojun #ifndef PULLDOWN_TEST
269 1.12 itojun IP6_EXTHDR_CHECK(m, 0, sizeof(struct ip6_hdr), );
270 1.12 itojun #else
271 1.12 itojun if (m->m_len < sizeof(struct ip6_hdr)) {
272 1.12 itojun m = m_pullup(m, sizeof(struct ip6_hdr));
273 1.12 itojun if (m == NULL)
274 1.12 itojun return;
275 1.12 itojun }
276 1.12 itojun #endif
277 1.2 itojun oip6 = mtod(m, struct ip6_hdr *);
278 1.2 itojun
279 1.2 itojun /*
280 1.2 itojun * Multicast destination check. For unrecognized option errors,
281 1.2 itojun * this check has already done in ip6_unknown_opt(), so we can
282 1.2 itojun * check only for other errors.
283 1.2 itojun */
284 1.2 itojun if ((m->m_flags & (M_BCAST|M_MCAST) ||
285 1.2 itojun IN6_IS_ADDR_MULTICAST(&oip6->ip6_dst)) &&
286 1.2 itojun (type != ICMP6_PACKET_TOO_BIG &&
287 1.2 itojun (type != ICMP6_PARAM_PROB ||
288 1.2 itojun code != ICMP6_PARAMPROB_OPTION)))
289 1.2 itojun goto freeit;
290 1.2 itojun
291 1.2 itojun /* Source address check. XXX: the case of anycast source? */
292 1.2 itojun if (IN6_IS_ADDR_UNSPECIFIED(&oip6->ip6_src) ||
293 1.2 itojun IN6_IS_ADDR_MULTICAST(&oip6->ip6_src))
294 1.2 itojun goto freeit;
295 1.2 itojun
296 1.2 itojun /*
297 1.27 itojun * If we are about to send ICMPv6 against ICMPv6 error/redirect,
298 1.27 itojun * don't do it.
299 1.2 itojun */
300 1.27 itojun nxt = -1;
301 1.28 itojun off = ip6_lasthdr(m, 0, IPPROTO_IPV6, &nxt);
302 1.27 itojun if (off >= 0 && nxt == IPPROTO_ICMPV6) {
303 1.2 itojun struct icmp6_hdr *icp;
304 1.2 itojun
305 1.12 itojun #ifndef PULLDOWN_TEST
306 1.27 itojun IP6_EXTHDR_CHECK(m, 0, off + sizeof(struct icmp6_hdr), );
307 1.27 itojun icp = (struct icmp6_hdr *)(mtod(m, caddr_t) + off);
308 1.12 itojun #else
309 1.27 itojun IP6_EXTHDR_GET(icp, struct icmp6_hdr *, m, off,
310 1.27 itojun sizeof(*icp));
311 1.27 itojun if (icp == NULL) {
312 1.27 itojun icmp6stat.icp6s_tooshort++;
313 1.27 itojun return;
314 1.27 itojun }
315 1.12 itojun #endif
316 1.27 itojun if (icp->icmp6_type < ICMP6_ECHO_REQUEST ||
317 1.27 itojun icp->icmp6_type == ND_REDIRECT) {
318 1.27 itojun /*
319 1.27 itojun * ICMPv6 error
320 1.27 itojun * Special case: for redirect (which is
321 1.27 itojun * informational) we must not send icmp6 error.
322 1.27 itojun */
323 1.27 itojun icmp6stat.icp6s_canterror++;
324 1.27 itojun goto freeit;
325 1.27 itojun } else {
326 1.27 itojun /* ICMPv6 informational - send the error */
327 1.2 itojun }
328 1.27 itojun } else {
329 1.27 itojun /* non-ICMPv6 - send the error */
330 1.2 itojun }
331 1.2 itojun
332 1.2 itojun oip6 = mtod(m, struct ip6_hdr *); /* adjust pointer */
333 1.2 itojun
334 1.2 itojun /* Finally, do rate limitation check. */
335 1.2 itojun if (icmp6_ratelimit(&oip6->ip6_src, type, code)) {
336 1.2 itojun icmp6stat.icp6s_toofreq++;
337 1.2 itojun goto freeit;
338 1.2 itojun }
339 1.2 itojun
340 1.2 itojun /*
341 1.2 itojun * OK, ICMP6 can be generated.
342 1.2 itojun */
343 1.2 itojun
344 1.2 itojun if (m->m_pkthdr.len >= ICMPV6_PLD_MAXLEN)
345 1.2 itojun m_adj(m, ICMPV6_PLD_MAXLEN - m->m_pkthdr.len);
346 1.2 itojun
347 1.17 itohy preplen = sizeof(struct ip6_hdr) + sizeof(struct icmp6_hdr);
348 1.17 itohy M_PREPEND(m, preplen, M_DONTWAIT);
349 1.17 itohy if (m && m->m_len < preplen)
350 1.17 itohy m = m_pullup(m, preplen);
351 1.2 itojun if (m == NULL) {
352 1.2 itojun printf("ENOBUFS in icmp6_error %d\n", __LINE__);
353 1.2 itojun return;
354 1.2 itojun }
355 1.2 itojun
356 1.2 itojun nip6 = mtod(m, struct ip6_hdr *);
357 1.2 itojun nip6->ip6_src = oip6->ip6_src;
358 1.2 itojun nip6->ip6_dst = oip6->ip6_dst;
359 1.2 itojun
360 1.2 itojun if (IN6_IS_SCOPE_LINKLOCAL(&oip6->ip6_src))
361 1.2 itojun oip6->ip6_src.s6_addr16[1] = 0;
362 1.2 itojun if (IN6_IS_SCOPE_LINKLOCAL(&oip6->ip6_dst))
363 1.2 itojun oip6->ip6_dst.s6_addr16[1] = 0;
364 1.2 itojun
365 1.2 itojun icmp6 = (struct icmp6_hdr *)(nip6 + 1);
366 1.2 itojun icmp6->icmp6_type = type;
367 1.2 itojun icmp6->icmp6_code = code;
368 1.7 itojun icmp6->icmp6_pptr = htonl((u_int32_t)param);
369 1.2 itojun
370 1.2 itojun icmp6stat.icp6s_outhist[type]++;
371 1.2 itojun icmp6_reflect(m, sizeof(struct ip6_hdr)); /*header order: IPv6 - ICMPv6*/
372 1.27 itojun
373 1.27 itojun return;
374 1.27 itojun
375 1.27 itojun freeit:
376 1.27 itojun /*
377 1.27 itojun * If we can't tell wheter or not we can generate ICMP6, free it.
378 1.27 itojun */
379 1.27 itojun m_freem(m);
380 1.2 itojun }
381 1.2 itojun
382 1.2 itojun /*
383 1.2 itojun * Process a received ICMP6 message.
384 1.2 itojun */
385 1.2 itojun int
386 1.2 itojun icmp6_input(mp, offp, proto)
387 1.2 itojun struct mbuf **mp;
388 1.2 itojun int *offp, proto;
389 1.2 itojun {
390 1.2 itojun struct mbuf *m = *mp, *n;
391 1.2 itojun struct ip6_hdr *ip6, *nip6;
392 1.2 itojun struct icmp6_hdr *icmp6, *nicmp6;
393 1.2 itojun int off = *offp;
394 1.2 itojun int icmp6len = m->m_pkthdr.len - *offp;
395 1.2 itojun int code, sum, noff;
396 1.2 itojun struct sockaddr_in6 icmp6src;
397 1.2 itojun
398 1.12 itojun #ifndef PULLDOWN_TEST
399 1.2 itojun IP6_EXTHDR_CHECK(m, off, sizeof(struct icmp6_hdr), IPPROTO_DONE);
400 1.2 itojun /* m might change if M_LOOP. So, call mtod after this */
401 1.12 itojun #endif
402 1.2 itojun
403 1.2 itojun /*
404 1.2 itojun * Locate icmp6 structure in mbuf, and check
405 1.2 itojun * that not corrupted and of at least minimum length
406 1.2 itojun */
407 1.2 itojun
408 1.2 itojun ip6 = mtod(m, struct ip6_hdr *);
409 1.2 itojun if (icmp6len < sizeof(struct icmp6_hdr)) {
410 1.2 itojun icmp6stat.icp6s_tooshort++;
411 1.2 itojun goto freeit;
412 1.2 itojun }
413 1.2 itojun
414 1.2 itojun /*
415 1.2 itojun * calculate the checksum
416 1.2 itojun */
417 1.12 itojun #ifndef PULLDOWN_TEST
418 1.2 itojun icmp6 = (struct icmp6_hdr *)((caddr_t)ip6 + off);
419 1.12 itojun #else
420 1.12 itojun IP6_EXTHDR_GET(icmp6, struct icmp6_hdr *, m, off, sizeof(*icmp6));
421 1.12 itojun if (icmp6 == NULL) {
422 1.12 itojun icmp6stat.icp6s_tooshort++;
423 1.12 itojun return IPPROTO_DONE;
424 1.12 itojun }
425 1.12 itojun #endif
426 1.2 itojun code = icmp6->icmp6_code;
427 1.2 itojun
428 1.2 itojun if ((sum = in6_cksum(m, IPPROTO_ICMPV6, off, icmp6len)) != 0) {
429 1.51 itojun #ifdef ND6_DEBUG
430 1.2 itojun log(LOG_ERR,
431 1.2 itojun "ICMP6 checksum error(%d|%x) %s\n",
432 1.50 itojun icmp6->icmp6_type, sum, ip6_sprintf(&ip6->ip6_src));
433 1.50 itojun #endif
434 1.2 itojun icmp6stat.icp6s_checksum++;
435 1.2 itojun goto freeit;
436 1.2 itojun }
437 1.2 itojun
438 1.2 itojun #if defined(NFAITH) && 0 < NFAITH
439 1.2 itojun if (m->m_pkthdr.rcvif && m->m_pkthdr.rcvif->if_type == IFT_FAITH) {
440 1.2 itojun /*
441 1.2 itojun * Deliver very specific ICMP6 type only.
442 1.2 itojun * This is important to deilver TOOBIG. Otherwise PMTUD
443 1.2 itojun * will not work.
444 1.2 itojun */
445 1.2 itojun switch (icmp6->icmp6_type) {
446 1.2 itojun case ICMP6_DST_UNREACH:
447 1.2 itojun case ICMP6_PACKET_TOO_BIG:
448 1.2 itojun case ICMP6_TIME_EXCEEDED:
449 1.2 itojun break;
450 1.2 itojun default:
451 1.2 itojun goto freeit;
452 1.2 itojun }
453 1.2 itojun }
454 1.2 itojun #endif
455 1.2 itojun
456 1.2 itojun #ifdef IPSEC
457 1.5 itojun /* drop it if it does not match the default policy */
458 1.2 itojun if (ipsec6_in_reject(m, NULL)) {
459 1.44 itojun ipsec6stat.in_polvio++;
460 1.2 itojun goto freeit;
461 1.2 itojun }
462 1.2 itojun #endif
463 1.2 itojun
464 1.2 itojun icmp6stat.icp6s_inhist[icmp6->icmp6_type]++;
465 1.12 itojun icmp6_ifstat_inc(m->m_pkthdr.rcvif, ifs6_in_msg);
466 1.12 itojun if (icmp6->icmp6_type < ICMP6_INFOMSG_MASK)
467 1.12 itojun icmp6_ifstat_inc(m->m_pkthdr.rcvif, ifs6_in_error);
468 1.2 itojun
469 1.2 itojun switch (icmp6->icmp6_type) {
470 1.2 itojun
471 1.2 itojun case ICMP6_DST_UNREACH:
472 1.12 itojun icmp6_ifstat_inc(m->m_pkthdr.rcvif, ifs6_in_dstunreach);
473 1.2 itojun switch (code) {
474 1.2 itojun case ICMP6_DST_UNREACH_NOROUTE:
475 1.2 itojun code = PRC_UNREACH_NET;
476 1.2 itojun break;
477 1.2 itojun case ICMP6_DST_UNREACH_ADMIN:
478 1.12 itojun icmp6_ifstat_inc(m->m_pkthdr.rcvif, ifs6_in_adminprohib);
479 1.23 itojun code = PRC_UNREACH_PROTOCOL; /* is this a good code? */
480 1.23 itojun break;
481 1.2 itojun case ICMP6_DST_UNREACH_ADDR:
482 1.23 itojun code = PRC_HOSTDEAD;
483 1.2 itojun break;
484 1.23 itojun #ifdef COMPAT_RFC1885
485 1.2 itojun case ICMP6_DST_UNREACH_NOTNEIGHBOR:
486 1.2 itojun code = PRC_UNREACH_SRCFAIL;
487 1.2 itojun break;
488 1.23 itojun #else
489 1.23 itojun case ICMP6_DST_UNREACH_BEYONDSCOPE:
490 1.23 itojun /* I mean "source address was incorrect." */
491 1.23 itojun code = PRC_PARAMPROB;
492 1.23 itojun break;
493 1.29 itojun #endif
494 1.2 itojun case ICMP6_DST_UNREACH_NOPORT:
495 1.2 itojun code = PRC_UNREACH_PORT;
496 1.2 itojun break;
497 1.2 itojun default:
498 1.2 itojun goto badcode;
499 1.2 itojun }
500 1.2 itojun goto deliver;
501 1.2 itojun break;
502 1.2 itojun
503 1.2 itojun case ICMP6_PACKET_TOO_BIG:
504 1.12 itojun icmp6_ifstat_inc(m->m_pkthdr.rcvif, ifs6_in_pkttoobig);
505 1.2 itojun if (code != 0)
506 1.2 itojun goto badcode;
507 1.2 itojun
508 1.2 itojun code = PRC_MSGSIZE;
509 1.2 itojun
510 1.23 itojun /*
511 1.23 itojun * Updating the path MTU will be done after examining
512 1.23 itojun * intermediate extension headers.
513 1.23 itojun */
514 1.2 itojun goto deliver;
515 1.2 itojun break;
516 1.2 itojun
517 1.2 itojun case ICMP6_TIME_EXCEEDED:
518 1.12 itojun icmp6_ifstat_inc(m->m_pkthdr.rcvif, ifs6_in_timeexceed);
519 1.2 itojun switch (code) {
520 1.2 itojun case ICMP6_TIME_EXCEED_TRANSIT:
521 1.2 itojun case ICMP6_TIME_EXCEED_REASSEMBLY:
522 1.2 itojun code += PRC_TIMXCEED_INTRANS;
523 1.2 itojun break;
524 1.2 itojun default:
525 1.2 itojun goto badcode;
526 1.2 itojun }
527 1.2 itojun goto deliver;
528 1.2 itojun break;
529 1.2 itojun
530 1.2 itojun case ICMP6_PARAM_PROB:
531 1.12 itojun icmp6_ifstat_inc(m->m_pkthdr.rcvif, ifs6_in_paramprob);
532 1.2 itojun switch (code) {
533 1.2 itojun case ICMP6_PARAMPROB_NEXTHEADER:
534 1.2 itojun code = PRC_UNREACH_PROTOCOL;
535 1.2 itojun break;
536 1.2 itojun case ICMP6_PARAMPROB_HEADER:
537 1.2 itojun case ICMP6_PARAMPROB_OPTION:
538 1.2 itojun code = PRC_PARAMPROB;
539 1.2 itojun break;
540 1.2 itojun default:
541 1.2 itojun goto badcode;
542 1.2 itojun }
543 1.2 itojun goto deliver;
544 1.2 itojun break;
545 1.2 itojun
546 1.2 itojun case ICMP6_ECHO_REQUEST:
547 1.12 itojun icmp6_ifstat_inc(m->m_pkthdr.rcvif, ifs6_in_echo);
548 1.2 itojun if (code != 0)
549 1.2 itojun goto badcode;
550 1.2 itojun if ((n = m_copy(m, 0, M_COPYALL)) == NULL) {
551 1.2 itojun /* Give up remote */
552 1.2 itojun break;
553 1.2 itojun }
554 1.12 itojun if ((n->m_flags & M_EXT) != 0
555 1.12 itojun || n->m_len < off + sizeof(struct icmp6_hdr)) {
556 1.2 itojun struct mbuf *n0 = n;
557 1.23 itojun const int maxlen = sizeof(*nip6) + sizeof(*nicmp6);
558 1.2 itojun
559 1.2 itojun /*
560 1.2 itojun * Prepare an internal mbuf. m_pullup() doesn't
561 1.2 itojun * always copy the length we specified.
562 1.2 itojun */
563 1.23 itojun if (maxlen >= MCLBYTES) {
564 1.23 itojun #ifdef DIAGNOSTIC
565 1.23 itojun printf("MCLBYTES too small\n");
566 1.23 itojun #endif
567 1.23 itojun /* Give up remote */
568 1.23 itojun m_freem(n0);
569 1.23 itojun break;
570 1.23 itojun }
571 1.2 itojun MGETHDR(n, M_DONTWAIT, n0->m_type);
572 1.23 itojun if (n && maxlen >= MHLEN) {
573 1.23 itojun MCLGET(n, M_DONTWAIT);
574 1.23 itojun if ((n->m_flags & M_EXT) == 0) {
575 1.23 itojun m_free(n);
576 1.23 itojun n = NULL;
577 1.23 itojun }
578 1.23 itojun }
579 1.2 itojun if (n == NULL) {
580 1.2 itojun /* Give up remote */
581 1.2 itojun m_freem(n0);
582 1.2 itojun break;
583 1.2 itojun }
584 1.2 itojun M_COPY_PKTHDR(n, n0);
585 1.2 itojun /*
586 1.2 itojun * Copy IPv6 and ICMPv6 only.
587 1.2 itojun */
588 1.2 itojun nip6 = mtod(n, struct ip6_hdr *);
589 1.2 itojun bcopy(ip6, nip6, sizeof(struct ip6_hdr));
590 1.2 itojun nicmp6 = (struct icmp6_hdr *)(nip6 + 1);
591 1.2 itojun bcopy(icmp6, nicmp6, sizeof(struct icmp6_hdr));
592 1.12 itojun noff = sizeof(struct ip6_hdr);
593 1.12 itojun n->m_pkthdr.len = n->m_len =
594 1.12 itojun noff + sizeof(struct icmp6_hdr);
595 1.2 itojun /*
596 1.12 itojun * Adjust mbuf. ip6_plen will be adjusted in
597 1.12 itojun * ip6_output().
598 1.2 itojun */
599 1.12 itojun m_adj(n0, off + sizeof(struct icmp6_hdr));
600 1.12 itojun n->m_pkthdr.len += n0->m_pkthdr.len;
601 1.12 itojun n->m_next = n0;
602 1.12 itojun n0->m_flags &= ~M_PKTHDR;
603 1.2 itojun } else {
604 1.2 itojun nip6 = mtod(n, struct ip6_hdr *);
605 1.2 itojun nicmp6 = (struct icmp6_hdr *)((caddr_t)nip6 + off);
606 1.2 itojun noff = off;
607 1.2 itojun }
608 1.2 itojun nicmp6->icmp6_type = ICMP6_ECHO_REPLY;
609 1.2 itojun nicmp6->icmp6_code = 0;
610 1.10 itojun if (n) {
611 1.10 itojun icmp6stat.icp6s_reflect++;
612 1.10 itojun icmp6stat.icp6s_outhist[ICMP6_ECHO_REPLY]++;
613 1.10 itojun icmp6_reflect(n, noff);
614 1.10 itojun }
615 1.2 itojun break;
616 1.2 itojun
617 1.2 itojun case ICMP6_ECHO_REPLY:
618 1.12 itojun icmp6_ifstat_inc(m->m_pkthdr.rcvif, ifs6_in_echoreply);
619 1.2 itojun if (code != 0)
620 1.2 itojun goto badcode;
621 1.2 itojun break;
622 1.2 itojun
623 1.2 itojun case MLD6_LISTENER_QUERY:
624 1.2 itojun case MLD6_LISTENER_REPORT:
625 1.2 itojun if (icmp6len < sizeof(struct mld6_hdr))
626 1.2 itojun goto badlen;
627 1.12 itojun if (icmp6->icmp6_type == MLD6_LISTENER_QUERY) /* XXX: ugly... */
628 1.12 itojun icmp6_ifstat_inc(m->m_pkthdr.rcvif, ifs6_in_mldquery);
629 1.12 itojun else
630 1.12 itojun icmp6_ifstat_inc(m->m_pkthdr.rcvif, ifs6_in_mldreport);
631 1.23 itojun if ((n = m_copym(m, 0, M_COPYALL, M_DONTWAIT)) == NULL) {
632 1.23 itojun /* give up local */
633 1.23 itojun mld6_input(m, off);
634 1.23 itojun m = NULL;
635 1.23 itojun goto freeit;
636 1.23 itojun }
637 1.23 itojun mld6_input(n, off);
638 1.2 itojun /* m stays. */
639 1.2 itojun break;
640 1.2 itojun
641 1.2 itojun case MLD6_LISTENER_DONE:
642 1.12 itojun icmp6_ifstat_inc(m->m_pkthdr.rcvif, ifs6_in_mlddone);
643 1.12 itojun if (icmp6len < sizeof(struct mld6_hdr)) /* necessary? */
644 1.2 itojun goto badlen;
645 1.2 itojun break; /* nothing to be done in kernel */
646 1.2 itojun
647 1.12 itojun case MLD6_MTRACE_RESP:
648 1.12 itojun case MLD6_MTRACE:
649 1.12 itojun /* XXX: these two are experimental. not officially defind. */
650 1.12 itojun /* XXX: per-interface statistics? */
651 1.23 itojun break; /* just pass it to applications */
652 1.12 itojun
653 1.2 itojun case ICMP6_WRUREQUEST: /* ICMP6_FQDN_QUERY */
654 1.2 itojun {
655 1.2 itojun enum { WRU, FQDN } mode;
656 1.2 itojun
657 1.14 itojun if (!icmp6_nodeinfo)
658 1.14 itojun break;
659 1.14 itojun
660 1.2 itojun if (icmp6len == sizeof(struct icmp6_hdr) + 4)
661 1.2 itojun mode = WRU;
662 1.31 itojun else if (icmp6len >= sizeof(struct icmp6_nodeinfo))
663 1.2 itojun mode = FQDN;
664 1.2 itojun else
665 1.2 itojun goto badlen;
666 1.2 itojun
667 1.2 itojun if (mode == FQDN) {
668 1.14 itojun #ifndef PULLDOWN_TEST
669 1.2 itojun IP6_EXTHDR_CHECK(m, off, sizeof(struct icmp6_nodeinfo),
670 1.2 itojun IPPROTO_DONE);
671 1.14 itojun #endif
672 1.14 itojun n = m_copy(m, 0, M_COPYALL);
673 1.14 itojun if (n)
674 1.14 itojun n = ni6_input(n, off);
675 1.31 itojun /* XXX meaningless if n == NULL */
676 1.31 itojun noff = sizeof(struct ip6_hdr);
677 1.14 itojun } else {
678 1.2 itojun u_char *p;
679 1.23 itojun int maxlen, maxhlen;
680 1.2 itojun
681 1.31 itojun if (code != 0)
682 1.31 itojun goto badcode;
683 1.23 itojun maxlen = sizeof(*nip6) + sizeof(*nicmp6) + 4;
684 1.23 itojun if (maxlen >= MCLBYTES) {
685 1.23 itojun #ifdef DIAGNOSTIC
686 1.23 itojun printf("MCLBYTES too small\n");
687 1.23 itojun #endif
688 1.23 itojun /* Give up remote */
689 1.23 itojun break;
690 1.23 itojun }
691 1.2 itojun MGETHDR(n, M_DONTWAIT, m->m_type);
692 1.23 itojun if (n && maxlen > MHLEN) {
693 1.23 itojun MCLGET(n, M_DONTWAIT);
694 1.23 itojun if ((n->m_flags & M_EXT) == 0) {
695 1.23 itojun m_free(n);
696 1.23 itojun n = NULL;
697 1.23 itojun }
698 1.23 itojun }
699 1.2 itojun if (n == NULL) {
700 1.2 itojun /* Give up remote */
701 1.2 itojun break;
702 1.2 itojun }
703 1.23 itojun n->m_len = 0;
704 1.23 itojun maxhlen = M_TRAILINGSPACE(n) - maxlen;
705 1.23 itojun if (maxhlen > hostnamelen)
706 1.23 itojun maxhlen = hostnamelen;
707 1.2 itojun /*
708 1.2 itojun * Copy IPv6 and ICMPv6 only.
709 1.2 itojun */
710 1.2 itojun nip6 = mtod(n, struct ip6_hdr *);
711 1.2 itojun bcopy(ip6, nip6, sizeof(struct ip6_hdr));
712 1.2 itojun nicmp6 = (struct icmp6_hdr *)(nip6 + 1);
713 1.2 itojun bcopy(icmp6, nicmp6, sizeof(struct icmp6_hdr));
714 1.2 itojun p = (u_char *)(nicmp6 + 1);
715 1.2 itojun bzero(p, 4);
716 1.31 itojun bcopy(hostname, p + 4, maxhlen); /*meaningless TTL*/
717 1.2 itojun noff = sizeof(struct ip6_hdr);
718 1.2 itojun M_COPY_PKTHDR(n, m); /* just for recvif */
719 1.2 itojun n->m_pkthdr.len = n->m_len = sizeof(struct ip6_hdr) +
720 1.23 itojun sizeof(struct icmp6_hdr) + 4 + maxhlen;
721 1.2 itojun nicmp6->icmp6_type = ICMP6_WRUREPLY;
722 1.2 itojun nicmp6->icmp6_code = 0;
723 1.2 itojun }
724 1.2 itojun #undef hostnamelen
725 1.2 itojun if (n) {
726 1.2 itojun icmp6stat.icp6s_reflect++;
727 1.2 itojun icmp6stat.icp6s_outhist[ICMP6_WRUREPLY]++;
728 1.2 itojun icmp6_reflect(n, noff);
729 1.2 itojun }
730 1.2 itojun break;
731 1.2 itojun }
732 1.2 itojun
733 1.2 itojun case ICMP6_WRUREPLY:
734 1.2 itojun if (code != 0)
735 1.2 itojun goto badcode;
736 1.2 itojun break;
737 1.2 itojun
738 1.2 itojun case ND_ROUTER_SOLICIT:
739 1.12 itojun icmp6_ifstat_inc(m->m_pkthdr.rcvif, ifs6_in_routersolicit);
740 1.2 itojun if (code != 0)
741 1.2 itojun goto badcode;
742 1.2 itojun if (icmp6len < sizeof(struct nd_router_solicit))
743 1.2 itojun goto badlen;
744 1.23 itojun if ((n = m_copym(m, 0, M_COPYALL, M_DONTWAIT)) == NULL) {
745 1.23 itojun /* give up local */
746 1.23 itojun nd6_rs_input(m, off, icmp6len);
747 1.23 itojun m = NULL;
748 1.23 itojun goto freeit;
749 1.23 itojun }
750 1.23 itojun nd6_rs_input(n, off, icmp6len);
751 1.2 itojun /* m stays. */
752 1.2 itojun break;
753 1.2 itojun
754 1.2 itojun case ND_ROUTER_ADVERT:
755 1.12 itojun icmp6_ifstat_inc(m->m_pkthdr.rcvif, ifs6_in_routeradvert);
756 1.2 itojun if (code != 0)
757 1.2 itojun goto badcode;
758 1.2 itojun if (icmp6len < sizeof(struct nd_router_advert))
759 1.2 itojun goto badlen;
760 1.23 itojun if ((n = m_copym(m, 0, M_COPYALL, M_DONTWAIT)) == NULL) {
761 1.23 itojun /* give up local */
762 1.23 itojun nd6_ra_input(m, off, icmp6len);
763 1.23 itojun m = NULL;
764 1.23 itojun goto freeit;
765 1.23 itojun }
766 1.23 itojun nd6_ra_input(n, off, icmp6len);
767 1.2 itojun /* m stays. */
768 1.2 itojun break;
769 1.2 itojun
770 1.2 itojun case ND_NEIGHBOR_SOLICIT:
771 1.12 itojun icmp6_ifstat_inc(m->m_pkthdr.rcvif, ifs6_in_neighborsolicit);
772 1.2 itojun if (code != 0)
773 1.2 itojun goto badcode;
774 1.2 itojun if (icmp6len < sizeof(struct nd_neighbor_solicit))
775 1.2 itojun goto badlen;
776 1.23 itojun if ((n = m_copym(m, 0, M_COPYALL, M_DONTWAIT)) == NULL) {
777 1.23 itojun /* give up local */
778 1.23 itojun nd6_ns_input(m, off, icmp6len);
779 1.23 itojun m = NULL;
780 1.23 itojun goto freeit;
781 1.23 itojun }
782 1.23 itojun nd6_ns_input(n, off, icmp6len);
783 1.2 itojun /* m stays. */
784 1.2 itojun break;
785 1.2 itojun
786 1.2 itojun case ND_NEIGHBOR_ADVERT:
787 1.12 itojun icmp6_ifstat_inc(m->m_pkthdr.rcvif, ifs6_in_neighboradvert);
788 1.2 itojun if (code != 0)
789 1.2 itojun goto badcode;
790 1.2 itojun if (icmp6len < sizeof(struct nd_neighbor_advert))
791 1.2 itojun goto badlen;
792 1.23 itojun if ((n = m_copym(m, 0, M_COPYALL, M_DONTWAIT)) == NULL) {
793 1.23 itojun /* give up local */
794 1.23 itojun nd6_na_input(m, off, icmp6len);
795 1.23 itojun m = NULL;
796 1.23 itojun goto freeit;
797 1.23 itojun }
798 1.23 itojun nd6_na_input(n, off, icmp6len);
799 1.2 itojun /* m stays. */
800 1.2 itojun break;
801 1.2 itojun
802 1.2 itojun case ND_REDIRECT:
803 1.12 itojun icmp6_ifstat_inc(m->m_pkthdr.rcvif, ifs6_in_redirect);
804 1.2 itojun if (code != 0)
805 1.2 itojun goto badcode;
806 1.2 itojun if (icmp6len < sizeof(struct nd_redirect))
807 1.2 itojun goto badlen;
808 1.23 itojun if ((n = m_copym(m, 0, M_COPYALL, M_DONTWAIT)) == NULL) {
809 1.23 itojun /* give up local */
810 1.23 itojun icmp6_redirect_input(m, off);
811 1.23 itojun m = NULL;
812 1.23 itojun goto freeit;
813 1.23 itojun }
814 1.23 itojun icmp6_redirect_input(n, off);
815 1.2 itojun /* m stays. */
816 1.2 itojun break;
817 1.2 itojun
818 1.2 itojun case ICMP6_ROUTER_RENUMBERING:
819 1.2 itojun if (code != ICMP6_ROUTER_RENUMBERING_COMMAND &&
820 1.2 itojun code != ICMP6_ROUTER_RENUMBERING_RESULT)
821 1.2 itojun goto badcode;
822 1.2 itojun if (icmp6len < sizeof(struct icmp6_router_renum))
823 1.2 itojun goto badlen;
824 1.2 itojun break;
825 1.2 itojun
826 1.2 itojun default:
827 1.12 itojun printf("icmp6_input: unknown type %d(src=%s, dst=%s, ifid=%d)\n",
828 1.12 itojun icmp6->icmp6_type, ip6_sprintf(&ip6->ip6_src),
829 1.12 itojun ip6_sprintf(&ip6->ip6_dst),
830 1.12 itojun m->m_pkthdr.rcvif ? m->m_pkthdr.rcvif->if_index : 0);
831 1.2 itojun if (icmp6->icmp6_type < ICMP6_ECHO_REQUEST) {
832 1.2 itojun /* ICMPv6 error: MUST deliver it by spec... */
833 1.2 itojun code = PRC_NCMDS;
834 1.2 itojun /* deliver */
835 1.2 itojun } else {
836 1.2 itojun /* ICMPv6 informational: MUST not deliver */
837 1.2 itojun break;
838 1.2 itojun }
839 1.2 itojun deliver:
840 1.2 itojun if (icmp6len < sizeof(struct icmp6_hdr) + sizeof(struct ip6_hdr)) {
841 1.2 itojun icmp6stat.icp6s_tooshort++;
842 1.2 itojun goto freeit;
843 1.2 itojun }
844 1.12 itojun #ifndef PULLDOWN_TEST
845 1.2 itojun IP6_EXTHDR_CHECK(m, off,
846 1.2 itojun sizeof(struct icmp6_hdr) + sizeof(struct ip6_hdr),
847 1.2 itojun IPPROTO_DONE);
848 1.2 itojun icmp6 = (struct icmp6_hdr *)(mtod(m, caddr_t) + off);
849 1.12 itojun #else
850 1.12 itojun IP6_EXTHDR_GET(icmp6, struct icmp6_hdr *, m, off,
851 1.12 itojun sizeof(*icmp6) + sizeof(struct ip6_hdr));
852 1.12 itojun if (icmp6 == NULL) {
853 1.12 itojun icmp6stat.icp6s_tooshort++;
854 1.12 itojun return IPPROTO_DONE;
855 1.12 itojun }
856 1.12 itojun #endif
857 1.2 itojun bzero(&icmp6src, sizeof(icmp6src));
858 1.2 itojun icmp6src.sin6_len = sizeof(struct sockaddr_in6);
859 1.2 itojun icmp6src.sin6_family = AF_INET6;
860 1.2 itojun icmp6src.sin6_addr = ((struct ip6_hdr *)(icmp6 + 1))->ip6_dst;
861 1.2 itojun
862 1.2 itojun /* Detect the upper level protocol */
863 1.2 itojun {
864 1.12 itojun void (*ctlfunc) __P((int, struct sockaddr *, void *));
865 1.2 itojun struct ip6_hdr *eip6 = (struct ip6_hdr *)(icmp6 + 1);
866 1.2 itojun u_int8_t nxt = eip6->ip6_nxt;
867 1.2 itojun int eoff = off + sizeof(struct icmp6_hdr) +
868 1.2 itojun sizeof(struct ip6_hdr);
869 1.12 itojun struct ip6ctlparam ip6cp;
870 1.23 itojun struct in6_addr *finaldst = NULL;
871 1.23 itojun struct ip6_frag *fh;
872 1.23 itojun struct ip6_rthdr *rth;
873 1.23 itojun struct ip6_rthdr0 *rth0;
874 1.23 itojun int rthlen;
875 1.2 itojun
876 1.2 itojun while (1) { /* XXX: should avoid inf. loop explicitly? */
877 1.2 itojun struct ip6_ext *eh;
878 1.2 itojun
879 1.2 itojun switch(nxt) {
880 1.2 itojun case IPPROTO_HOPOPTS:
881 1.2 itojun case IPPROTO_DSTOPTS:
882 1.2 itojun case IPPROTO_AH:
883 1.12 itojun #ifndef PULLDOWN_TEST
884 1.2 itojun IP6_EXTHDR_CHECK(m, 0, eoff +
885 1.2 itojun sizeof(struct ip6_ext),
886 1.2 itojun IPPROTO_DONE);
887 1.2 itojun eh = (struct ip6_ext *)(mtod(m, caddr_t)
888 1.2 itojun + eoff);
889 1.12 itojun #else
890 1.12 itojun IP6_EXTHDR_GET(eh, struct ip6_ext *, m,
891 1.12 itojun eoff, sizeof(*eh));
892 1.12 itojun if (eh == NULL) {
893 1.12 itojun icmp6stat.icp6s_tooshort++;
894 1.12 itojun return IPPROTO_DONE;
895 1.12 itojun }
896 1.12 itojun #endif
897 1.23 itojun
898 1.2 itojun if (nxt == IPPROTO_AH)
899 1.2 itojun eoff += (eh->ip6e_len + 2) << 2;
900 1.2 itojun else
901 1.2 itojun eoff += (eh->ip6e_len + 1) << 3;
902 1.2 itojun nxt = eh->ip6e_nxt;
903 1.2 itojun break;
904 1.23 itojun case IPPROTO_ROUTING:
905 1.23 itojun /*
906 1.23 itojun * When the erroneous packet contains a
907 1.23 itojun * routing header, we should examine the
908 1.23 itojun * header to determine the final destination.
909 1.23 itojun * Otherwise, we can't properly update
910 1.23 itojun * information that depends on the final
911 1.23 itojun * destination (e.g. path MTU).
912 1.23 itojun */
913 1.23 itojun #ifndef PULLDOWN_TEST
914 1.23 itojun IP6_EXTHDR_CHECK(m, 0, eoff + sizeof(*rth),
915 1.23 itojun IPPROTO_DONE);
916 1.23 itojun rth = (struct ip6_rthdr *)(mtod(m, caddr_t)
917 1.23 itojun + eoff);
918 1.23 itojun #else
919 1.23 itojun IP6_EXTHDR_GET(rth, struct ip6_rthdr *, m,
920 1.23 itojun eoff, sizeof(*rth));
921 1.23 itojun if (rth == NULL) {
922 1.23 itojun icmp6stat.icp6s_tooshort++;
923 1.23 itojun return IPPROTO_DONE;
924 1.23 itojun }
925 1.23 itojun #endif
926 1.23 itojun rthlen = (rth->ip6r_len + 1) << 3;
927 1.23 itojun /*
928 1.23 itojun * XXX: currently there is no
929 1.23 itojun * officially defined type other
930 1.23 itojun * than type-0.
931 1.23 itojun * Note that if the segment left field
932 1.23 itojun * is 0, all intermediate hops must
933 1.23 itojun * have been passed.
934 1.23 itojun */
935 1.23 itojun if (rth->ip6r_segleft &&
936 1.23 itojun rth->ip6r_type == IPV6_RTHDR_TYPE_0) {
937 1.23 itojun int hops;
938 1.23 itojun
939 1.23 itojun #ifndef PULLDOWN_TEST
940 1.23 itojun IP6_EXTHDR_CHECK(m, 0, eoff + rthlen,
941 1.23 itojun IPPROTO_DONE);
942 1.23 itojun rth0 = (struct ip6_rthdr0 *)(mtod(m, caddr_t) + eoff);
943 1.23 itojun #else
944 1.23 itojun IP6_EXTHDR_GET(rth0,
945 1.23 itojun struct ip6_rthdr0 *, m,
946 1.23 itojun eoff, rthlen);
947 1.23 itojun if (rth0 == NULL) {
948 1.23 itojun icmp6stat.icp6s_tooshort++;
949 1.23 itojun return IPPROTO_DONE;
950 1.23 itojun }
951 1.23 itojun #endif
952 1.23 itojun /* just ignore a bogus header */
953 1.23 itojun if ((rth0->ip6r0_len % 2) == 0 &&
954 1.23 itojun (hops = rth0->ip6r0_len/2))
955 1.23 itojun finaldst = (struct in6_addr *)(rth0 + 1) + (hops - 1);
956 1.23 itojun }
957 1.23 itojun eoff += rthlen;
958 1.23 itojun nxt = rth->ip6r_nxt;
959 1.23 itojun break;
960 1.23 itojun case IPPROTO_FRAGMENT:
961 1.23 itojun #ifndef PULLDOWN_TEST
962 1.23 itojun IP6_EXTHDR_CHECK(m, 0, eoff +
963 1.23 itojun sizeof(struct ip6_frag),
964 1.23 itojun IPPROTO_DONE);
965 1.23 itojun fh = (struct ip6_frag *)(mtod(m, caddr_t)
966 1.23 itojun + eoff);
967 1.23 itojun #else
968 1.23 itojun IP6_EXTHDR_GET(fh, struct ip6_frag *, m,
969 1.23 itojun eoff, sizeof(*fh));
970 1.23 itojun if (fh == NULL) {
971 1.23 itojun icmp6stat.icp6s_tooshort++;
972 1.23 itojun return IPPROTO_DONE;
973 1.23 itojun }
974 1.23 itojun #endif
975 1.23 itojun /*
976 1.23 itojun * Data after a fragment header is meaningless
977 1.23 itojun * unless it is the first fragment, but
978 1.23 itojun * we'll go to the notify label for path MTU
979 1.23 itojun * discovery.
980 1.23 itojun */
981 1.23 itojun if (fh->ip6f_offlg & IP6F_OFF_MASK)
982 1.23 itojun goto notify;
983 1.23 itojun
984 1.23 itojun eoff += sizeof(struct ip6_frag);
985 1.23 itojun nxt = fh->ip6f_nxt;
986 1.23 itojun break;
987 1.2 itojun default:
988 1.23 itojun /*
989 1.23 itojun * This case includes ESP and the No Next
990 1.23 itojun * Header. In such cases going to the notify
991 1.23 itojun * label does not have any meaning
992 1.23 itojun * (i.e. ctlfunc will be NULL), but we go
993 1.23 itojun * anyway since we might have to update
994 1.23 itojun * path MTU information.
995 1.23 itojun */
996 1.2 itojun goto notify;
997 1.2 itojun }
998 1.2 itojun }
999 1.2 itojun notify:
1000 1.12 itojun #ifndef PULLDOWN_TEST
1001 1.2 itojun icmp6 = (struct icmp6_hdr *)(mtod(m, caddr_t) + off);
1002 1.12 itojun #else
1003 1.12 itojun IP6_EXTHDR_GET(icmp6, struct icmp6_hdr *, m, off,
1004 1.12 itojun sizeof(*icmp6) + sizeof(struct ip6_hdr));
1005 1.12 itojun if (icmp6 == NULL) {
1006 1.12 itojun icmp6stat.icp6s_tooshort++;
1007 1.12 itojun return IPPROTO_DONE;
1008 1.12 itojun }
1009 1.12 itojun #endif
1010 1.46 itojun if (finaldst == NULL)
1011 1.46 itojun finaldst = &((struct ip6_hdr *)(icmp6 + 1))->ip6_dst;
1012 1.46 itojun ip6cp.ip6c_m = m;
1013 1.46 itojun ip6cp.ip6c_icmp6 = icmp6;
1014 1.46 itojun ip6cp.ip6c_ip6 = (struct ip6_hdr *)(icmp6 + 1);
1015 1.46 itojun ip6cp.ip6c_off = eoff;
1016 1.46 itojun ip6cp.ip6c_finaldst = finaldst;
1017 1.23 itojun
1018 1.12 itojun ctlfunc = (void (*) __P((int, struct sockaddr *, void *)))
1019 1.2 itojun (inet6sw[ip6_protox[nxt]].pr_ctlinput);
1020 1.12 itojun if (ctlfunc) {
1021 1.46 itojun (void) (*ctlfunc)(code, (struct sockaddr *)&icmp6src,
1022 1.46 itojun &ip6cp);
1023 1.12 itojun }
1024 1.2 itojun }
1025 1.2 itojun break;
1026 1.2 itojun
1027 1.2 itojun badcode:
1028 1.2 itojun icmp6stat.icp6s_badcode++;
1029 1.2 itojun break;
1030 1.2 itojun
1031 1.2 itojun badlen:
1032 1.2 itojun icmp6stat.icp6s_badlen++;
1033 1.2 itojun break;
1034 1.2 itojun }
1035 1.2 itojun
1036 1.2 itojun icmp6_rip6_input(&m, *offp);
1037 1.2 itojun return IPPROTO_DONE;
1038 1.2 itojun
1039 1.2 itojun freeit:
1040 1.2 itojun m_freem(m);
1041 1.2 itojun return IPPROTO_DONE;
1042 1.2 itojun }
1043 1.2 itojun
1044 1.46 itojun void
1045 1.48 itojun icmp6_mtudisc_update(ip6cp, validated)
1046 1.46 itojun struct ip6ctlparam *ip6cp;
1047 1.48 itojun int validated;
1048 1.23 itojun {
1049 1.48 itojun unsigned long rtcount;
1050 1.46 itojun struct icmp6_mtudisc_callback *mc;
1051 1.46 itojun struct in6_addr *dst = ip6cp->ip6c_finaldst;
1052 1.46 itojun struct icmp6_hdr *icmp6 = ip6cp->ip6c_icmp6;
1053 1.46 itojun struct mbuf *m = ip6cp->ip6c_m; /* will be necessary for scope issue */
1054 1.23 itojun u_int mtu = ntohl(icmp6->icmp6_mtu);
1055 1.23 itojun struct rtentry *rt = NULL;
1056 1.23 itojun struct sockaddr_in6 sin6;
1057 1.23 itojun
1058 1.48 itojun /*
1059 1.48 itojun * allow non-validated cases if memory is plenty, to make traffic
1060 1.48 itojun * from non-connected pcb happy.
1061 1.48 itojun */
1062 1.48 itojun rtcount = rt_timer_count(icmp6_mtudisc_timeout_q);
1063 1.48 itojun if (validated) {
1064 1.48 itojun if (rtcount > icmp6_mtudisc_hiwat)
1065 1.48 itojun return;
1066 1.48 itojun else if (rtcount > icmp6_mtudisc_lowat) {
1067 1.48 itojun /*
1068 1.48 itojun * XXX nuke a victim, install the new one.
1069 1.48 itojun */
1070 1.48 itojun }
1071 1.48 itojun } else {
1072 1.48 itojun if (rtcount > icmp6_mtudisc_lowat)
1073 1.48 itojun return;
1074 1.48 itojun }
1075 1.48 itojun
1076 1.23 itojun bzero(&sin6, sizeof(sin6));
1077 1.23 itojun sin6.sin6_family = PF_INET6;
1078 1.23 itojun sin6.sin6_len = sizeof(struct sockaddr_in6);
1079 1.23 itojun sin6.sin6_addr = *dst;
1080 1.46 itojun /* XXX normally, this won't happen */
1081 1.46 itojun if (IN6_IS_ADDR_LINKLOCAL(dst)) {
1082 1.46 itojun sin6.sin6_addr.s6_addr16[1] =
1083 1.46 itojun htons(m->m_pkthdr.rcvif->if_index);
1084 1.46 itojun }
1085 1.23 itojun /* sin6.sin6_scope_id = XXX: should be set if DST is a scoped addr */
1086 1.49 itojun rt = icmp6_mtudisc_clone((struct sockaddr *)&sin6);
1087 1.23 itojun
1088 1.23 itojun if (rt && (rt->rt_flags & RTF_HOST)
1089 1.23 itojun && !(rt->rt_rmx.rmx_locks & RTV_MTU)) {
1090 1.23 itojun if (mtu < IPV6_MMTU) {
1091 1.23 itojun /* xxx */
1092 1.23 itojun rt->rt_rmx.rmx_locks |= RTV_MTU;
1093 1.23 itojun } else if (mtu < rt->rt_ifp->if_mtu &&
1094 1.23 itojun rt->rt_rmx.rmx_mtu > mtu) {
1095 1.46 itojun icmp6stat.icp6s_pmtuchg++;
1096 1.23 itojun rt->rt_rmx.rmx_mtu = mtu;
1097 1.23 itojun }
1098 1.23 itojun }
1099 1.23 itojun if (rt)
1100 1.23 itojun RTFREE(rt);
1101 1.46 itojun
1102 1.46 itojun /*
1103 1.46 itojun * Notify protocols that the MTU for this destination
1104 1.46 itojun * has changed.
1105 1.46 itojun */
1106 1.46 itojun for (mc = LIST_FIRST(&icmp6_mtudisc_callbacks); mc != NULL;
1107 1.46 itojun mc = LIST_NEXT(mc, mc_list))
1108 1.46 itojun (*mc->mc_func)(&sin6.sin6_addr);
1109 1.23 itojun }
1110 1.23 itojun
1111 1.2 itojun /*
1112 1.40 itojun * Process a Node Information Query packet, based on
1113 1.47 itojun * draft-ietf-ipngwg-icmp-name-lookups-07.
1114 1.31 itojun *
1115 1.31 itojun * Spec incompatibilities:
1116 1.31 itojun * - IPv6 Subject address handling
1117 1.31 itojun * - IPv4 Subject address handling support missing
1118 1.31 itojun * - Proxy reply (answer even if it's not for me)
1119 1.31 itojun * - joins NI group address at in6_ifattach() time only, does not cope
1120 1.31 itojun * with hostname changes by sethostname(3)
1121 1.2 itojun */
1122 1.2 itojun #ifndef offsetof /* XXX */
1123 1.2 itojun #define offsetof(type, member) ((size_t)(&((type *)0)->member))
1124 1.29 itojun #endif
1125 1.2 itojun static struct mbuf *
1126 1.2 itojun ni6_input(m, off)
1127 1.2 itojun struct mbuf *m;
1128 1.2 itojun int off;
1129 1.2 itojun {
1130 1.12 itojun struct icmp6_nodeinfo *ni6, *nni6;
1131 1.2 itojun struct mbuf *n = NULL;
1132 1.12 itojun u_int16_t qtype;
1133 1.31 itojun int subjlen;
1134 1.2 itojun int replylen = sizeof(struct ip6_hdr) + sizeof(struct icmp6_nodeinfo);
1135 1.2 itojun struct ni_reply_fqdn *fqdn;
1136 1.2 itojun int addrs; /* for NI_QTYPE_NODEADDR */
1137 1.2 itojun struct ifnet *ifp = NULL; /* for NI_QTYPE_NODEADDR */
1138 1.47 itojun struct sockaddr_in6 sin6; /* double meaning; ip6_dst and subjectaddr */
1139 1.31 itojun struct ip6_hdr *ip6;
1140 1.31 itojun int oldfqdn = 0; /* if 1, return pascal string (03 draft) */
1141 1.47 itojun char *subj = NULL;
1142 1.2 itojun
1143 1.31 itojun ip6 = mtod(m, struct ip6_hdr *);
1144 1.12 itojun #ifndef PULLDOWN_TEST
1145 1.12 itojun ni6 = (struct icmp6_nodeinfo *)(mtod(m, caddr_t) + off);
1146 1.12 itojun #else
1147 1.14 itojun IP6_EXTHDR_GET(ni6, struct icmp6_nodeinfo *, m, off, sizeof(*ni6));
1148 1.14 itojun if (ni6 == NULL) {
1149 1.14 itojun /* m is already reclaimed */
1150 1.12 itojun return NULL;
1151 1.14 itojun }
1152 1.12 itojun #endif
1153 1.31 itojun
1154 1.31 itojun /*
1155 1.31 itojun * Validate IPv6 destination address.
1156 1.31 itojun *
1157 1.47 itojun * The Responder must discard the Query without further processing
1158 1.47 itojun * unless it is one of the Responder's unicast or anycast addresses, or
1159 1.47 itojun * a link-local scope multicast address which the Responder has joined.
1160 1.47 itojun * [icmp-name-lookups-07, Section 4.]
1161 1.31 itojun */
1162 1.31 itojun bzero(&sin6, sizeof(sin6));
1163 1.31 itojun sin6.sin6_family = AF_INET6;
1164 1.31 itojun sin6.sin6_len = sizeof(struct sockaddr_in6);
1165 1.31 itojun bcopy(&ip6->ip6_dst, &sin6.sin6_addr, sizeof(sin6.sin6_addr));
1166 1.31 itojun /* XXX scopeid */
1167 1.31 itojun if (ifa_ifwithaddr((struct sockaddr *)&sin6))
1168 1.47 itojun ; /* unicast/anycast, fine */
1169 1.31 itojun else if (IN6_IS_ADDR_MC_LINKLOCAL(&sin6.sin6_addr))
1170 1.47 itojun ; /* link-local multicast, fine */
1171 1.31 itojun else
1172 1.31 itojun goto bad;
1173 1.31 itojun
1174 1.47 itojun /* validate query Subject field. */
1175 1.12 itojun qtype = ntohs(ni6->ni_qtype);
1176 1.31 itojun subjlen = m->m_pkthdr.len - off - sizeof(struct icmp6_nodeinfo);
1177 1.31 itojun switch (qtype) {
1178 1.31 itojun case NI_QTYPE_NOOP:
1179 1.31 itojun case NI_QTYPE_SUPTYPES:
1180 1.47 itojun /* 07 draft */
1181 1.40 itojun if (ni6->ni_code == ICMP6_NI_SUBJ_FQDN && subjlen == 0)
1182 1.40 itojun break;
1183 1.40 itojun /*FALLTHROUGH*/
1184 1.31 itojun case NI_QTYPE_FQDN:
1185 1.31 itojun case NI_QTYPE_NODEADDR:
1186 1.31 itojun switch (ni6->ni_code) {
1187 1.31 itojun case ICMP6_NI_SUBJ_IPV6:
1188 1.31 itojun #if ICMP6_NI_SUBJ_IPV6 != 0
1189 1.31 itojun case 0:
1190 1.31 itojun #endif
1191 1.31 itojun /*
1192 1.31 itojun * backward compatibility - try to accept 03 draft
1193 1.31 itojun * format, where no Subject is present.
1194 1.31 itojun */
1195 1.40 itojun if (qtype == NI_QTYPE_FQDN && ni6->ni_code == 0 &&
1196 1.40 itojun subjlen == 0) {
1197 1.31 itojun oldfqdn++;
1198 1.31 itojun break;
1199 1.31 itojun }
1200 1.40 itojun #if ICMP6_NI_SUBJ_IPV6 != 0
1201 1.40 itojun if (ni6->ni_code != ICMP6_NI_SUBJ_IPV6)
1202 1.40 itojun goto bad;
1203 1.40 itojun #endif
1204 1.31 itojun
1205 1.31 itojun if (subjlen != sizeof(sin6.sin6_addr))
1206 1.31 itojun goto bad;
1207 1.31 itojun
1208 1.31 itojun /*
1209 1.31 itojun * Validate Subject address.
1210 1.31 itojun *
1211 1.31 itojun * Not sure what exactly does "address belongs to the
1212 1.31 itojun * node" mean in the spec, is it just unicast, or what?
1213 1.31 itojun *
1214 1.31 itojun * At this moment we consider Subject address as
1215 1.31 itojun * "belong to the node" if the Subject address equals
1216 1.31 itojun * to the IPv6 destination address; validation for
1217 1.31 itojun * IPv6 destination address should have done enough
1218 1.31 itojun * check for us.
1219 1.31 itojun *
1220 1.31 itojun * We do not do proxy at this moment.
1221 1.31 itojun */
1222 1.31 itojun /* m_pulldown instead of copy? */
1223 1.31 itojun m_copydata(m, off + sizeof(struct icmp6_nodeinfo),
1224 1.31 itojun subjlen, (caddr_t)&sin6.sin6_addr);
1225 1.31 itojun /* XXX kame scope hack */
1226 1.31 itojun if (IN6_IS_SCOPE_LINKLOCAL(&sin6.sin6_addr)) {
1227 1.31 itojun #ifdef FAKE_LOOPBACK_IF
1228 1.31 itojun if ((m->m_flags & M_PKTHDR) != 0 &&
1229 1.31 itojun m->m_pkthdr.rcvif) {
1230 1.31 itojun sin6.sin6_addr.s6_addr16[1] =
1231 1.31 itojun htons(m->m_pkthdr.rcvif->if_index);
1232 1.31 itojun }
1233 1.31 itojun #else
1234 1.31 itojun if (IN6_IS_SCOPE_LINKLOCAL(&ip6->ip6_dst)) {
1235 1.31 itojun sin6.sin6_addr.s6_addr16[1] =
1236 1.31 itojun ip6->ip6_dst.s6_addr16[1];
1237 1.31 itojun }
1238 1.31 itojun #endif
1239 1.31 itojun }
1240 1.47 itojun subj = (char *)&sin6;
1241 1.31 itojun if (IN6_ARE_ADDR_EQUAL(&ip6->ip6_dst, &sin6.sin6_addr))
1242 1.31 itojun break;
1243 1.47 itojun
1244 1.31 itojun /*
1245 1.31 itojun * XXX if we are to allow other cases, we should really
1246 1.31 itojun * be careful about scope here.
1247 1.31 itojun * basically, we should disallow queries toward IPv6
1248 1.31 itojun * destination X with subject Y, if scope(X) > scope(Y).
1249 1.31 itojun * if we allow scope(X) > scope(Y), it will result in
1250 1.31 itojun * information leakage across scope boundary.
1251 1.31 itojun */
1252 1.31 itojun goto bad;
1253 1.31 itojun
1254 1.31 itojun case ICMP6_NI_SUBJ_FQDN:
1255 1.31 itojun /*
1256 1.31 itojun * Validate Subject name with gethostname(3).
1257 1.31 itojun *
1258 1.31 itojun * The behavior may need some debate, since:
1259 1.31 itojun * - we are not sure if the node has FQDN as
1260 1.31 itojun * hostname (returned by gethostname(3)).
1261 1.31 itojun * - the code does wildcard match for truncated names.
1262 1.31 itojun * however, we are not sure if we want to perform
1263 1.31 itojun * wildcard match, if gethostname(3) side has
1264 1.31 itojun * truncated hostname.
1265 1.31 itojun */
1266 1.31 itojun n = ni6_nametodns(hostname, hostnamelen, 0);
1267 1.31 itojun if (!n || n->m_next || n->m_len == 0)
1268 1.31 itojun goto bad;
1269 1.31 itojun IP6_EXTHDR_GET(subj, char *, m,
1270 1.31 itojun off + sizeof(struct icmp6_nodeinfo), subjlen);
1271 1.31 itojun if (subj == NULL)
1272 1.31 itojun goto bad;
1273 1.31 itojun if (!ni6_dnsmatch(subj, subjlen, mtod(n, const char *),
1274 1.31 itojun n->m_len)) {
1275 1.31 itojun goto bad;
1276 1.31 itojun }
1277 1.31 itojun m_freem(n);
1278 1.31 itojun n = NULL;
1279 1.31 itojun break;
1280 1.31 itojun
1281 1.47 itojun case ICMP6_NI_SUBJ_IPV4: /* XXX: to be implemented? */
1282 1.31 itojun default:
1283 1.31 itojun goto bad;
1284 1.31 itojun }
1285 1.31 itojun break;
1286 1.2 itojun }
1287 1.2 itojun
1288 1.47 itojun /* guess reply length */
1289 1.47 itojun switch (qtype) {
1290 1.47 itojun case NI_QTYPE_NOOP:
1291 1.47 itojun break; /* no reply data */
1292 1.47 itojun case NI_QTYPE_SUPTYPES:
1293 1.47 itojun replylen += sizeof(u_int32_t);
1294 1.47 itojun break;
1295 1.47 itojun case NI_QTYPE_FQDN:
1296 1.47 itojun /* XXX will append an mbuf */
1297 1.47 itojun replylen += offsetof(struct ni_reply_fqdn, ni_fqdn_namelen);
1298 1.47 itojun break;
1299 1.47 itojun case NI_QTYPE_NODEADDR:
1300 1.47 itojun addrs = ni6_addrs(ni6, m, &ifp, subj);
1301 1.47 itojun if ((replylen += addrs * (sizeof(struct in6_addr) +
1302 1.47 itojun sizeof(u_int32_t))) > MCLBYTES)
1303 1.47 itojun replylen = MCLBYTES; /* XXX: will truncate pkt later */
1304 1.47 itojun break;
1305 1.47 itojun default:
1306 1.47 itojun /*
1307 1.47 itojun * XXX: We must return a reply with the ICMP6 code
1308 1.47 itojun * `unknown Qtype' in this case. However we regard the case
1309 1.47 itojun * as an FQDN query for backward compatibility.
1310 1.47 itojun * Older versions set a random value to this field,
1311 1.47 itojun * so it rarely varies in the defined qtypes.
1312 1.47 itojun * But the mechanism is not reliable...
1313 1.47 itojun * maybe we should obsolete older versions.
1314 1.47 itojun */
1315 1.47 itojun qtype = NI_QTYPE_FQDN;
1316 1.47 itojun /* XXX will append an mbuf */
1317 1.47 itojun replylen += offsetof(struct ni_reply_fqdn, ni_fqdn_namelen);
1318 1.47 itojun oldfqdn++;
1319 1.47 itojun break;
1320 1.47 itojun }
1321 1.47 itojun
1322 1.47 itojun /* allocate an mbuf to reply. */
1323 1.2 itojun MGETHDR(n, M_DONTWAIT, m->m_type);
1324 1.14 itojun if (n == NULL) {
1325 1.14 itojun m_freem(m);
1326 1.2 itojun return(NULL);
1327 1.14 itojun }
1328 1.2 itojun M_COPY_PKTHDR(n, m); /* just for recvif */
1329 1.2 itojun if (replylen > MHLEN) {
1330 1.31 itojun if (replylen > MCLBYTES) {
1331 1.2 itojun /*
1332 1.47 itojun * XXX: should we try to allocate more? But MCLBYTES
1333 1.47 itojun * is probably much larger than IPV6_MMTU...
1334 1.2 itojun */
1335 1.2 itojun goto bad;
1336 1.31 itojun }
1337 1.2 itojun MCLGET(n, M_DONTWAIT);
1338 1.2 itojun if ((n->m_flags & M_EXT) == 0) {
1339 1.2 itojun goto bad;
1340 1.2 itojun }
1341 1.2 itojun }
1342 1.2 itojun n->m_pkthdr.len = n->m_len = replylen;
1343 1.2 itojun
1344 1.2 itojun /* copy mbuf header and IPv6 + Node Information base headers */
1345 1.2 itojun bcopy(mtod(m, caddr_t), mtod(n, caddr_t), sizeof(struct ip6_hdr));
1346 1.29 itojun nni6 = (struct icmp6_nodeinfo *)(mtod(n, struct ip6_hdr *) + 1);
1347 1.12 itojun bcopy((caddr_t)ni6, (caddr_t)nni6, sizeof(struct icmp6_nodeinfo));
1348 1.2 itojun
1349 1.2 itojun /* qtype dependent procedure */
1350 1.2 itojun switch (qtype) {
1351 1.31 itojun case NI_QTYPE_NOOP:
1352 1.40 itojun nni6->ni_code = ICMP6_NI_SUCCESS;
1353 1.31 itojun nni6->ni_flags = 0;
1354 1.31 itojun break;
1355 1.31 itojun case NI_QTYPE_SUPTYPES:
1356 1.42 itojun {
1357 1.42 itojun u_int32_t v;
1358 1.40 itojun nni6->ni_code = ICMP6_NI_SUCCESS;
1359 1.40 itojun nni6->ni_flags = htons(0x0000); /* raw bitmap */
1360 1.40 itojun /* supports NOOP, SUPTYPES, FQDN, and NODEADDR */
1361 1.42 itojun v = (u_int32_t)htonl(0x0000000f);
1362 1.42 itojun bcopy(&v, nni6 + 1, sizeof(u_int32_t));
1363 1.31 itojun break;
1364 1.42 itojun }
1365 1.31 itojun case NI_QTYPE_FQDN:
1366 1.40 itojun nni6->ni_code = ICMP6_NI_SUCCESS;
1367 1.31 itojun fqdn = (struct ni_reply_fqdn *)(mtod(n, caddr_t) +
1368 1.31 itojun sizeof(struct ip6_hdr) +
1369 1.31 itojun sizeof(struct icmp6_nodeinfo));
1370 1.31 itojun nni6->ni_flags = 0; /* XXX: meaningless TTL */
1371 1.31 itojun fqdn->ni_fqdn_ttl = 0; /* ditto. */
1372 1.31 itojun /*
1373 1.31 itojun * XXX do we really have FQDN in variable "hostname"?
1374 1.31 itojun */
1375 1.31 itojun n->m_next = ni6_nametodns(hostname, hostnamelen, oldfqdn);
1376 1.31 itojun if (n->m_next == NULL)
1377 1.31 itojun goto bad;
1378 1.31 itojun /* XXX we assume that n->m_next is not a chain */
1379 1.31 itojun if (n->m_next->m_next != NULL)
1380 1.31 itojun goto bad;
1381 1.31 itojun n->m_pkthdr.len += n->m_next->m_len;
1382 1.31 itojun break;
1383 1.31 itojun case NI_QTYPE_NODEADDR:
1384 1.31 itojun {
1385 1.31 itojun int lenlim, copied;
1386 1.31 itojun
1387 1.40 itojun nni6->ni_code = ICMP6_NI_SUCCESS;
1388 1.42 itojun n->m_pkthdr.len = n->m_len =
1389 1.42 itojun sizeof(struct ip6_hdr) + sizeof(struct icmp6_nodeinfo);
1390 1.42 itojun lenlim = M_TRAILINGSPACE(n);
1391 1.31 itojun copied = ni6_store_addrs(ni6, nni6, ifp, lenlim);
1392 1.31 itojun /* XXX: reset mbuf length */
1393 1.31 itojun n->m_pkthdr.len = n->m_len = sizeof(struct ip6_hdr) +
1394 1.31 itojun sizeof(struct icmp6_nodeinfo) + copied;
1395 1.31 itojun break;
1396 1.31 itojun }
1397 1.31 itojun default:
1398 1.31 itojun break; /* XXX impossible! */
1399 1.2 itojun }
1400 1.2 itojun
1401 1.2 itojun nni6->ni_type = ICMP6_NI_REPLY;
1402 1.14 itojun m_freem(m);
1403 1.2 itojun return(n);
1404 1.2 itojun
1405 1.2 itojun bad:
1406 1.14 itojun m_freem(m);
1407 1.2 itojun if (n)
1408 1.2 itojun m_freem(n);
1409 1.2 itojun return(NULL);
1410 1.2 itojun }
1411 1.2 itojun #undef hostnamelen
1412 1.2 itojun
1413 1.2 itojun /*
1414 1.31 itojun * make a mbuf with DNS-encoded string. no compression support.
1415 1.31 itojun *
1416 1.31 itojun * XXX names with less than 2 dots (like "foo" or "foo.section") will be
1417 1.31 itojun * treated as truncated name (two \0 at the end). this is a wild guess.
1418 1.31 itojun */
1419 1.31 itojun static struct mbuf *
1420 1.31 itojun ni6_nametodns(name, namelen, old)
1421 1.31 itojun const char *name;
1422 1.31 itojun int namelen;
1423 1.31 itojun int old; /* return pascal string if non-zero */
1424 1.31 itojun {
1425 1.31 itojun struct mbuf *m;
1426 1.31 itojun char *cp, *ep;
1427 1.31 itojun const char *p, *q;
1428 1.31 itojun int i, len, nterm;
1429 1.31 itojun
1430 1.31 itojun if (old)
1431 1.31 itojun len = namelen + 1;
1432 1.31 itojun else
1433 1.31 itojun len = MCLBYTES;
1434 1.31 itojun
1435 1.31 itojun /* because MAXHOSTNAMELEN is usually 256, we use cluster mbuf */
1436 1.31 itojun MGET(m, M_DONTWAIT, MT_DATA);
1437 1.31 itojun if (m && len > MLEN) {
1438 1.31 itojun MCLGET(m, M_DONTWAIT);
1439 1.31 itojun if ((m->m_flags & M_EXT) == 0)
1440 1.31 itojun goto fail;
1441 1.31 itojun }
1442 1.31 itojun if (!m)
1443 1.31 itojun goto fail;
1444 1.31 itojun m->m_next = NULL;
1445 1.31 itojun
1446 1.31 itojun if (old) {
1447 1.31 itojun m->m_len = len;
1448 1.31 itojun *mtod(m, char *) = namelen;
1449 1.31 itojun bcopy(name, mtod(m, char *) + 1, namelen);
1450 1.31 itojun return m;
1451 1.31 itojun } else {
1452 1.31 itojun m->m_len = 0;
1453 1.31 itojun cp = mtod(m, char *);
1454 1.31 itojun ep = mtod(m, char *) + M_TRAILINGSPACE(m);
1455 1.31 itojun
1456 1.31 itojun /* if not certain about my name, return empty buffer */
1457 1.31 itojun if (namelen == 0)
1458 1.31 itojun return m;
1459 1.31 itojun
1460 1.31 itojun /*
1461 1.31 itojun * guess if it looks like shortened hostname, or FQDN.
1462 1.31 itojun * shortened hostname needs two trailing "\0".
1463 1.31 itojun */
1464 1.31 itojun i = 0;
1465 1.31 itojun for (p = name; p < name + namelen; p++) {
1466 1.31 itojun if (*p && *p == '.')
1467 1.31 itojun i++;
1468 1.31 itojun }
1469 1.31 itojun if (i < 2)
1470 1.31 itojun nterm = 2;
1471 1.31 itojun else
1472 1.31 itojun nterm = 1;
1473 1.31 itojun
1474 1.31 itojun p = name;
1475 1.31 itojun while (cp < ep && p < name + namelen) {
1476 1.31 itojun i = 0;
1477 1.31 itojun for (q = p; q < name + namelen && *q && *q != '.'; q++)
1478 1.31 itojun i++;
1479 1.31 itojun /* result does not fit into mbuf */
1480 1.31 itojun if (cp + i + 1 >= ep)
1481 1.31 itojun goto fail;
1482 1.31 itojun /* DNS label length restriction, RFC1035 page 8 */
1483 1.31 itojun if (i >= 64)
1484 1.31 itojun goto fail;
1485 1.31 itojun *cp++ = i;
1486 1.31 itojun bcopy(p, cp, i);
1487 1.31 itojun cp += i;
1488 1.31 itojun p = q;
1489 1.31 itojun if (p < name + namelen && *p == '.')
1490 1.31 itojun p++;
1491 1.31 itojun }
1492 1.31 itojun /* termination */
1493 1.31 itojun if (cp + nterm >= ep)
1494 1.31 itojun goto fail;
1495 1.31 itojun while (nterm-- > 0)
1496 1.31 itojun *cp++ = '\0';
1497 1.31 itojun m->m_len = cp - mtod(m, char *);
1498 1.31 itojun return m;
1499 1.31 itojun }
1500 1.31 itojun
1501 1.31 itojun panic("should not reach here");
1502 1.31 itojun /*NOTREACHED*/
1503 1.31 itojun
1504 1.31 itojun fail:
1505 1.31 itojun if (m)
1506 1.31 itojun m_freem(m);
1507 1.31 itojun return NULL;
1508 1.31 itojun }
1509 1.31 itojun
1510 1.31 itojun /*
1511 1.31 itojun * check if two DNS-encoded string matches. takes care of truncated
1512 1.31 itojun * form (with \0\0 at the end). no compression support.
1513 1.40 itojun * XXX upper/lowercase match (see RFC2065)
1514 1.31 itojun */
1515 1.31 itojun static int
1516 1.31 itojun ni6_dnsmatch(a, alen, b, blen)
1517 1.31 itojun const char *a;
1518 1.31 itojun int alen;
1519 1.31 itojun const char *b;
1520 1.31 itojun int blen;
1521 1.31 itojun {
1522 1.31 itojun const char *a0, *b0;
1523 1.31 itojun int l;
1524 1.31 itojun
1525 1.31 itojun /* simplest case - need validation? */
1526 1.31 itojun if (alen == blen && bcmp(a, b, alen) == 0)
1527 1.31 itojun return 1;
1528 1.31 itojun
1529 1.31 itojun a0 = a;
1530 1.31 itojun b0 = b;
1531 1.31 itojun
1532 1.31 itojun /* termination is mandatory */
1533 1.31 itojun if (alen < 2 || blen < 2)
1534 1.31 itojun return 0;
1535 1.31 itojun if (a0[alen - 1] != '\0' || b0[blen - 1] != '\0')
1536 1.31 itojun return 0;
1537 1.31 itojun alen--;
1538 1.31 itojun blen--;
1539 1.31 itojun
1540 1.31 itojun while (a - a0 < alen && b - b0 < blen) {
1541 1.31 itojun if (a - a0 + 1 > alen || b - b0 + 1 > blen)
1542 1.31 itojun return 0;
1543 1.31 itojun
1544 1.33 itojun if ((signed char)a[0] < 0 || (signed char)b[0] < 0)
1545 1.31 itojun return 0;
1546 1.31 itojun /* we don't support compression yet */
1547 1.31 itojun if (a[0] >= 64 || b[0] >= 64)
1548 1.31 itojun return 0;
1549 1.31 itojun
1550 1.31 itojun /* truncated case */
1551 1.31 itojun if (a[0] == 0 && a - a0 == alen - 1)
1552 1.31 itojun return 1;
1553 1.31 itojun if (b[0] == 0 && b - b0 == blen - 1)
1554 1.31 itojun return 1;
1555 1.31 itojun if (a[0] == 0 || b[0] == 0)
1556 1.31 itojun return 0;
1557 1.31 itojun
1558 1.31 itojun if (a[0] != b[0])
1559 1.31 itojun return 0;
1560 1.31 itojun l = a[0];
1561 1.31 itojun if (a - a0 + 1 + l > alen || b - b0 + 1 + l > blen)
1562 1.31 itojun return 0;
1563 1.31 itojun if (bcmp(a + 1, b + 1, l) != 0)
1564 1.31 itojun return 0;
1565 1.31 itojun
1566 1.31 itojun a += 1 + l;
1567 1.31 itojun b += 1 + l;
1568 1.31 itojun }
1569 1.31 itojun
1570 1.31 itojun if (a - a0 == alen && b - b0 == blen)
1571 1.31 itojun return 1;
1572 1.31 itojun else
1573 1.31 itojun return 0;
1574 1.31 itojun }
1575 1.31 itojun
1576 1.31 itojun /*
1577 1.2 itojun * calculate the number of addresses to be returned in the node info reply.
1578 1.2 itojun */
1579 1.2 itojun static int
1580 1.47 itojun ni6_addrs(ni6, m, ifpp, subj)
1581 1.2 itojun struct icmp6_nodeinfo *ni6;
1582 1.2 itojun struct mbuf *m;
1583 1.2 itojun struct ifnet **ifpp;
1584 1.47 itojun char *subj;
1585 1.2 itojun {
1586 1.2 itojun register struct ifnet *ifp;
1587 1.2 itojun register struct in6_ifaddr *ifa6;
1588 1.2 itojun register struct ifaddr *ifa;
1589 1.47 itojun struct sockaddr_in6 *subj_ip6 = NULL; /* XXX pedant */
1590 1.2 itojun int addrs = 0, addrsofif, iffound = 0;
1591 1.47 itojun int niflags = ni6->ni_flags;
1592 1.47 itojun
1593 1.47 itojun if ((niflags & NI_NODEADDR_FLAG_ALL) == 0) {
1594 1.47 itojun switch(ni6->ni_code) {
1595 1.47 itojun case ICMP6_NI_SUBJ_IPV6:
1596 1.47 itojun if (subj == NULL) /* must be impossible... */
1597 1.47 itojun return(0);
1598 1.47 itojun subj_ip6 = (struct sockaddr_in6 *)subj;
1599 1.47 itojun break;
1600 1.47 itojun default:
1601 1.47 itojun /*
1602 1.47 itojun * XXX: we only support IPv6 subject address for
1603 1.47 itojun * this Qtype.
1604 1.47 itojun */
1605 1.47 itojun return(0);
1606 1.47 itojun }
1607 1.47 itojun }
1608 1.2 itojun
1609 1.2 itojun for (ifp = TAILQ_FIRST(&ifnet); ifp; ifp = TAILQ_NEXT(ifp, if_list))
1610 1.2 itojun {
1611 1.2 itojun addrsofif = 0;
1612 1.2 itojun for (ifa = ifp->if_addrlist.tqh_first; ifa;
1613 1.2 itojun ifa = ifa->ifa_list.tqe_next)
1614 1.2 itojun {
1615 1.2 itojun if (ifa->ifa_addr->sa_family != AF_INET6)
1616 1.2 itojun continue;
1617 1.2 itojun ifa6 = (struct in6_ifaddr *)ifa;
1618 1.2 itojun
1619 1.47 itojun if ((niflags & NI_NODEADDR_FLAG_ALL) == 0 &&
1620 1.47 itojun IN6_ARE_ADDR_EQUAL(&subj_ip6->sin6_addr,
1621 1.2 itojun &ifa6->ia_addr.sin6_addr))
1622 1.2 itojun iffound = 1;
1623 1.24 itojun
1624 1.24 itojun /*
1625 1.24 itojun * IPv4-mapped addresses can only be returned by a
1626 1.24 itojun * Node Information proxy, since they represent
1627 1.24 itojun * addresses of IPv4-only nodes, which perforce do
1628 1.24 itojun * not implement this protocol.
1629 1.47 itojun * [icmp-name-lookups-07, Section 5.4]
1630 1.24 itojun * So we don't support NI_NODEADDR_FLAG_COMPAT in
1631 1.24 itojun * this function at this moment.
1632 1.24 itojun */
1633 1.2 itojun
1634 1.2 itojun /* What do we have to do about ::1? */
1635 1.2 itojun switch(in6_addrscope(&ifa6->ia_addr.sin6_addr)) {
1636 1.47 itojun case IPV6_ADDR_SCOPE_LINKLOCAL:
1637 1.47 itojun if ((niflags & NI_NODEADDR_FLAG_LINKLOCAL)
1638 1.47 itojun == 0)
1639 1.47 itojun continue;
1640 1.2 itojun break;
1641 1.47 itojun case IPV6_ADDR_SCOPE_SITELOCAL:
1642 1.47 itojun if ((niflags & NI_NODEADDR_FLAG_SITELOCAL)
1643 1.47 itojun == 0)
1644 1.47 itojun continue;
1645 1.47 itojun break;
1646 1.47 itojun case IPV6_ADDR_SCOPE_GLOBAL:
1647 1.47 itojun if ((niflags & NI_NODEADDR_FLAG_GLOBAL)
1648 1.47 itojun == 0)
1649 1.47 itojun continue;
1650 1.2 itojun break;
1651 1.47 itojun default:
1652 1.47 itojun continue;
1653 1.2 itojun }
1654 1.47 itojun
1655 1.47 itojun /*
1656 1.47 itojun * check if anycast is okay.
1657 1.47 itojun * XXX: just experimental. not in the spec.
1658 1.47 itojun */
1659 1.47 itojun if ((ifa6->ia6_flags & IN6_IFF_ANYCAST) != 0 &&
1660 1.47 itojun (niflags & NI_NODEADDR_FLAG_ANYCAST) == 0)
1661 1.47 itojun continue; /* we need only unicast addresses */
1662 1.47 itojun
1663 1.47 itojun addrsofif++; /* count the address */
1664 1.2 itojun }
1665 1.2 itojun if (iffound) {
1666 1.2 itojun *ifpp = ifp;
1667 1.2 itojun return(addrsofif);
1668 1.2 itojun }
1669 1.2 itojun
1670 1.2 itojun addrs += addrsofif;
1671 1.2 itojun }
1672 1.2 itojun
1673 1.2 itojun return(addrs);
1674 1.2 itojun }
1675 1.2 itojun
1676 1.2 itojun static int
1677 1.2 itojun ni6_store_addrs(ni6, nni6, ifp0, resid)
1678 1.2 itojun struct icmp6_nodeinfo *ni6, *nni6;
1679 1.2 itojun struct ifnet *ifp0;
1680 1.2 itojun int resid;
1681 1.2 itojun {
1682 1.2 itojun register struct ifnet *ifp = ifp0 ? ifp0 : TAILQ_FIRST(&ifnet);
1683 1.2 itojun register struct in6_ifaddr *ifa6;
1684 1.2 itojun register struct ifaddr *ifa;
1685 1.47 itojun struct ifnet *ifp_dep = NULL;
1686 1.47 itojun int copied = 0, allow_deprecated = 0;
1687 1.2 itojun u_char *cp = (u_char *)(nni6 + 1);
1688 1.47 itojun int niflags = ni6->ni_flags;
1689 1.47 itojun u_int32_t ltime;
1690 1.47 itojun long time_second = time.tv_sec;
1691 1.2 itojun
1692 1.47 itojun if (ifp0 == NULL && !(niflags & NI_NODEADDR_FLAG_ALL))
1693 1.2 itojun return(0); /* needless to copy */
1694 1.2 itojun
1695 1.47 itojun again:
1696 1.47 itojun
1697 1.2 itojun for (; ifp; ifp = TAILQ_NEXT(ifp, if_list))
1698 1.2 itojun {
1699 1.2 itojun for (ifa = ifp->if_addrlist.tqh_first; ifa;
1700 1.2 itojun ifa = ifa->ifa_list.tqe_next)
1701 1.2 itojun {
1702 1.2 itojun if (ifa->ifa_addr->sa_family != AF_INET6)
1703 1.2 itojun continue;
1704 1.2 itojun ifa6 = (struct in6_ifaddr *)ifa;
1705 1.2 itojun
1706 1.47 itojun if ((ifa6->ia6_flags & IN6_IFF_DEPRECATED) != 0 &&
1707 1.47 itojun allow_deprecated == 0) {
1708 1.47 itojun /*
1709 1.47 itojun * prefererred address should be put before
1710 1.47 itojun * deprecated addresses.
1711 1.47 itojun */
1712 1.47 itojun
1713 1.47 itojun /* record the interface for later search */
1714 1.47 itojun if (ifp_dep == NULL)
1715 1.47 itojun ifp_dep = ifp;
1716 1.47 itojun
1717 1.47 itojun continue;
1718 1.12 itojun }
1719 1.47 itojun else if ((ifa6->ia6_flags & IN6_IFF_DEPRECATED) == 0 &&
1720 1.47 itojun allow_deprecated != 0)
1721 1.47 itojun continue; /* we now collect deprecated addrs */
1722 1.2 itojun
1723 1.2 itojun /* What do we have to do about ::1? */
1724 1.2 itojun switch(in6_addrscope(&ifa6->ia_addr.sin6_addr)) {
1725 1.47 itojun case IPV6_ADDR_SCOPE_LINKLOCAL:
1726 1.47 itojun if ((niflags & NI_NODEADDR_FLAG_LINKLOCAL)
1727 1.47 itojun == 0)
1728 1.47 itojun continue;
1729 1.2 itojun break;
1730 1.47 itojun case IPV6_ADDR_SCOPE_SITELOCAL:
1731 1.47 itojun if ((niflags & NI_NODEADDR_FLAG_SITELOCAL)
1732 1.47 itojun == 0)
1733 1.47 itojun continue;
1734 1.47 itojun break;
1735 1.47 itojun case IPV6_ADDR_SCOPE_GLOBAL:
1736 1.47 itojun if ((niflags & NI_NODEADDR_FLAG_GLOBAL)
1737 1.47 itojun == 0)
1738 1.47 itojun continue;
1739 1.2 itojun break;
1740 1.47 itojun default:
1741 1.47 itojun continue;
1742 1.47 itojun }
1743 1.47 itojun
1744 1.47 itojun /*
1745 1.47 itojun * check if anycast is okay.
1746 1.47 itojun * XXX: just experimental. not in the spec.
1747 1.47 itojun */
1748 1.47 itojun if ((ifa6->ia6_flags & IN6_IFF_ANYCAST) != 0 &&
1749 1.47 itojun (niflags & NI_NODEADDR_FLAG_ANYCAST) == 0)
1750 1.47 itojun continue;
1751 1.47 itojun
1752 1.47 itojun /* now we can copy the address */
1753 1.47 itojun if (resid < sizeof(struct in6_addr) +
1754 1.47 itojun sizeof(u_int32_t)) {
1755 1.47 itojun /*
1756 1.47 itojun * We give up much more copy.
1757 1.47 itojun * Set the truncate flag and return.
1758 1.47 itojun */
1759 1.47 itojun nni6->ni_flags |=
1760 1.47 itojun NI_NODEADDR_FLAG_TRUNCATE;
1761 1.47 itojun return(copied);
1762 1.2 itojun }
1763 1.2 itojun
1764 1.47 itojun /*
1765 1.47 itojun * Set the TTL of the address.
1766 1.47 itojun * The TTL value should be one of the following
1767 1.47 itojun * according to the specification:
1768 1.47 itojun *
1769 1.47 itojun * 1. The remaining lifetime of a DHCP lease on the
1770 1.47 itojun * address, or
1771 1.47 itojun * 2. The remaining Valid Lifetime of a prefix from
1772 1.47 itojun * which the address was derived through Stateless
1773 1.47 itojun * Autoconfiguration.
1774 1.47 itojun *
1775 1.47 itojun * Note that we currently do not support stateful
1776 1.47 itojun * address configuration by DHCPv6, so the former
1777 1.47 itojun * case can't happen.
1778 1.47 itojun */
1779 1.47 itojun if (ifa6->ia6_lifetime.ia6t_expire == 0)
1780 1.47 itojun ltime = ND6_INFINITE_LIFETIME;
1781 1.47 itojun else {
1782 1.47 itojun if (ifa6->ia6_lifetime.ia6t_expire >
1783 1.47 itojun time_second)
1784 1.47 itojun ltime = htonl(ifa6->ia6_lifetime.ia6t_expire - time_second);
1785 1.47 itojun else
1786 1.47 itojun ltime = 0;
1787 1.2 itojun }
1788 1.47 itojun
1789 1.47 itojun bcopy(<ime, cp, sizeof(u_int32_t));
1790 1.47 itojun cp += sizeof(u_int32_t);
1791 1.47 itojun
1792 1.47 itojun /* copy the address itself */
1793 1.47 itojun bcopy(&ifa6->ia_addr.sin6_addr, cp,
1794 1.47 itojun sizeof(struct in6_addr));
1795 1.47 itojun /* XXX: KAME link-local hack; remove ifindex */
1796 1.47 itojun if (IN6_IS_ADDR_LINKLOCAL(&ifa6->ia_addr.sin6_addr))
1797 1.47 itojun ((struct in6_addr *)cp)->s6_addr16[1] = 0;
1798 1.47 itojun cp += sizeof(struct in6_addr);
1799 1.47 itojun
1800 1.47 itojun resid -= (sizeof(struct in6_addr) + sizeof(u_int32_t));
1801 1.47 itojun copied += (sizeof(struct in6_addr) +
1802 1.47 itojun sizeof(u_int32_t));
1803 1.2 itojun }
1804 1.2 itojun if (ifp0) /* we need search only on the specified IF */
1805 1.2 itojun break;
1806 1.47 itojun }
1807 1.47 itojun
1808 1.47 itojun if (allow_deprecated == 0 && ifp_dep != NULL) {
1809 1.47 itojun ifp = ifp_dep;
1810 1.47 itojun allow_deprecated = 1;
1811 1.47 itojun
1812 1.47 itojun goto again;
1813 1.2 itojun }
1814 1.2 itojun
1815 1.2 itojun return(copied);
1816 1.2 itojun }
1817 1.2 itojun
1818 1.2 itojun /*
1819 1.2 itojun * XXX almost dup'ed code with rip6_input.
1820 1.2 itojun */
1821 1.2 itojun static int
1822 1.2 itojun icmp6_rip6_input(mp, off)
1823 1.2 itojun struct mbuf **mp;
1824 1.2 itojun int off;
1825 1.2 itojun {
1826 1.2 itojun struct mbuf *m = *mp;
1827 1.2 itojun register struct ip6_hdr *ip6 = mtod(m, struct ip6_hdr *);
1828 1.2 itojun register struct in6pcb *in6p;
1829 1.2 itojun struct in6pcb *last = NULL;
1830 1.2 itojun struct sockaddr_in6 rip6src;
1831 1.2 itojun struct icmp6_hdr *icmp6;
1832 1.2 itojun struct mbuf *opts = NULL;
1833 1.2 itojun
1834 1.23 itojun #ifndef PULLDOWN_TEST
1835 1.2 itojun /* this is assumed to be safe. */
1836 1.2 itojun icmp6 = (struct icmp6_hdr *)((caddr_t)ip6 + off);
1837 1.23 itojun #else
1838 1.23 itojun IP6_EXTHDR_GET(icmp6, struct icmp6_hdr *, m, off, sizeof(*icmp6));
1839 1.23 itojun if (icmp6 == NULL) {
1840 1.23 itojun /* m is already reclaimed */
1841 1.23 itojun return IPPROTO_DONE;
1842 1.23 itojun }
1843 1.23 itojun #endif
1844 1.2 itojun
1845 1.2 itojun bzero(&rip6src, sizeof(rip6src));
1846 1.2 itojun rip6src.sin6_len = sizeof(struct sockaddr_in6);
1847 1.2 itojun rip6src.sin6_family = AF_INET6;
1848 1.36 itojun /* KAME hack: recover scopeid */
1849 1.36 itojun (void)in6_recoverscope(&rip6src, &ip6->ip6_src, m->m_pkthdr.rcvif);
1850 1.2 itojun
1851 1.2 itojun for (in6p = rawin6pcb.in6p_next;
1852 1.2 itojun in6p != &rawin6pcb; in6p = in6p->in6p_next)
1853 1.2 itojun {
1854 1.2 itojun if (in6p->in6p_ip6_nxt != IPPROTO_ICMPV6)
1855 1.2 itojun continue;
1856 1.12 itojun if (!IN6_IS_ADDR_UNSPECIFIED(&in6p->in6p_laddr) &&
1857 1.2 itojun !IN6_ARE_ADDR_EQUAL(&in6p->in6p_laddr, &ip6->ip6_dst))
1858 1.2 itojun continue;
1859 1.12 itojun if (!IN6_IS_ADDR_UNSPECIFIED(&in6p->in6p_faddr) &&
1860 1.2 itojun !IN6_ARE_ADDR_EQUAL(&in6p->in6p_faddr, &ip6->ip6_src))
1861 1.2 itojun continue;
1862 1.2 itojun if (in6p->in6p_icmp6filt
1863 1.2 itojun && ICMP6_FILTER_WILLBLOCK(icmp6->icmp6_type,
1864 1.2 itojun in6p->in6p_icmp6filt))
1865 1.2 itojun continue;
1866 1.2 itojun if (last) {
1867 1.2 itojun struct mbuf *n;
1868 1.2 itojun if ((n = m_copy(m, 0, (int)M_COPYALL)) != NULL) {
1869 1.2 itojun if (last->in6p_flags & IN6P_CONTROLOPTS)
1870 1.2 itojun ip6_savecontrol(last, &opts, ip6, n);
1871 1.2 itojun /* strip intermediate headers */
1872 1.2 itojun m_adj(n, off);
1873 1.2 itojun if (sbappendaddr(&last->in6p_socket->so_rcv,
1874 1.2 itojun (struct sockaddr *)&rip6src,
1875 1.2 itojun n, opts) == 0) {
1876 1.2 itojun /* should notify about lost packet */
1877 1.2 itojun m_freem(n);
1878 1.2 itojun if (opts)
1879 1.2 itojun m_freem(opts);
1880 1.2 itojun } else
1881 1.2 itojun sorwakeup(last->in6p_socket);
1882 1.2 itojun opts = NULL;
1883 1.2 itojun }
1884 1.2 itojun }
1885 1.2 itojun last = in6p;
1886 1.2 itojun }
1887 1.2 itojun if (last) {
1888 1.2 itojun if (last->in6p_flags & IN6P_CONTROLOPTS)
1889 1.2 itojun ip6_savecontrol(last, &opts, ip6, m);
1890 1.2 itojun /* strip intermediate headers */
1891 1.2 itojun m_adj(m, off);
1892 1.2 itojun if (sbappendaddr(&last->in6p_socket->so_rcv,
1893 1.2 itojun (struct sockaddr *)&rip6src, m, opts) == 0) {
1894 1.2 itojun m_freem(m);
1895 1.2 itojun if (opts)
1896 1.2 itojun m_freem(opts);
1897 1.2 itojun } else
1898 1.2 itojun sorwakeup(last->in6p_socket);
1899 1.2 itojun } else {
1900 1.2 itojun m_freem(m);
1901 1.2 itojun ip6stat.ip6s_delivered--;
1902 1.2 itojun }
1903 1.2 itojun return IPPROTO_DONE;
1904 1.2 itojun }
1905 1.2 itojun
1906 1.2 itojun /*
1907 1.2 itojun * Reflect the ip6 packet back to the source.
1908 1.14 itojun * OFF points to the icmp6 header, counted from the top of the mbuf.
1909 1.2 itojun */
1910 1.2 itojun void
1911 1.2 itojun icmp6_reflect(m, off)
1912 1.2 itojun struct mbuf *m;
1913 1.2 itojun size_t off;
1914 1.2 itojun {
1915 1.12 itojun struct ip6_hdr *ip6;
1916 1.2 itojun struct icmp6_hdr *icmp6;
1917 1.2 itojun struct in6_ifaddr *ia;
1918 1.2 itojun struct in6_addr t, *src = 0;
1919 1.12 itojun int plen;
1920 1.12 itojun int type, code;
1921 1.12 itojun struct ifnet *outif = NULL;
1922 1.2 itojun #ifdef COMPAT_RFC1885
1923 1.2 itojun int mtu = IPV6_MMTU;
1924 1.2 itojun struct sockaddr_in6 *sin6 = &icmp6_reflect_rt.ro_dst;
1925 1.29 itojun #endif
1926 1.2 itojun
1927 1.12 itojun /* too short to reflect */
1928 1.12 itojun if (off < sizeof(struct ip6_hdr)) {
1929 1.12 itojun printf("sanity fail: off=%lx, sizeof(ip6)=%lx in %s:%d\n",
1930 1.12 itojun (u_long)off, (u_long)sizeof(struct ip6_hdr),
1931 1.12 itojun __FILE__, __LINE__);
1932 1.12 itojun goto bad;
1933 1.12 itojun }
1934 1.12 itojun
1935 1.2 itojun /*
1936 1.2 itojun * If there are extra headers between IPv6 and ICMPv6, strip
1937 1.2 itojun * off that header first.
1938 1.2 itojun */
1939 1.35 itojun #ifdef DIAGNOSTIC
1940 1.35 itojun if (sizeof(struct ip6_hdr) + sizeof(struct icmp6_hdr) > MHLEN)
1941 1.35 itojun panic("assumption failed in icmp6_reflect");
1942 1.35 itojun #endif
1943 1.12 itojun if (off > sizeof(struct ip6_hdr)) {
1944 1.12 itojun size_t l;
1945 1.12 itojun struct ip6_hdr nip6;
1946 1.12 itojun
1947 1.12 itojun l = off - sizeof(struct ip6_hdr);
1948 1.12 itojun m_copydata(m, 0, sizeof(nip6), (caddr_t)&nip6);
1949 1.12 itojun m_adj(m, l);
1950 1.12 itojun l = sizeof(struct ip6_hdr) + sizeof(struct icmp6_hdr);
1951 1.12 itojun if (m->m_len < l) {
1952 1.12 itojun if ((m = m_pullup(m, l)) == NULL)
1953 1.12 itojun return;
1954 1.12 itojun }
1955 1.12 itojun bcopy((caddr_t)&nip6, mtod(m, caddr_t), sizeof(nip6));
1956 1.12 itojun } else /* off == sizeof(struct ip6_hdr) */ {
1957 1.12 itojun size_t l;
1958 1.12 itojun l = sizeof(struct ip6_hdr) + sizeof(struct icmp6_hdr);
1959 1.12 itojun if (m->m_len < l) {
1960 1.12 itojun if ((m = m_pullup(m, l)) == NULL)
1961 1.12 itojun return;
1962 1.2 itojun }
1963 1.2 itojun }
1964 1.12 itojun plen = m->m_pkthdr.len - sizeof(struct ip6_hdr);
1965 1.12 itojun ip6 = mtod(m, struct ip6_hdr *);
1966 1.12 itojun ip6->ip6_nxt = IPPROTO_ICMPV6;
1967 1.2 itojun icmp6 = (struct icmp6_hdr *)(ip6 + 1);
1968 1.12 itojun type = icmp6->icmp6_type; /* keep type for statistics */
1969 1.12 itojun code = icmp6->icmp6_code; /* ditto. */
1970 1.2 itojun
1971 1.2 itojun t = ip6->ip6_dst;
1972 1.2 itojun /*
1973 1.2 itojun * ip6_input() drops a packet if its src is multicast.
1974 1.2 itojun * So, the src is never multicast.
1975 1.2 itojun */
1976 1.2 itojun ip6->ip6_dst = ip6->ip6_src;
1977 1.2 itojun
1978 1.2 itojun /* XXX hack for link-local addresses */
1979 1.2 itojun if (IN6_IS_ADDR_LINKLOCAL(&ip6->ip6_dst))
1980 1.2 itojun ip6->ip6_dst.s6_addr16[1] =
1981 1.2 itojun htons(m->m_pkthdr.rcvif->if_index);
1982 1.2 itojun if (IN6_IS_ADDR_LINKLOCAL(&t))
1983 1.2 itojun t.s6_addr16[1] = htons(m->m_pkthdr.rcvif->if_index);
1984 1.2 itojun
1985 1.2 itojun #ifdef COMPAT_RFC1885
1986 1.2 itojun /*
1987 1.2 itojun * xxx guess MTU
1988 1.2 itojun * RFC 1885 requires that echo reply should be truncated if it
1989 1.2 itojun * does not fit in with (return) path MTU, but the description was
1990 1.2 itojun * removed in the new spec.
1991 1.2 itojun */
1992 1.2 itojun if (icmp6_reflect_rt.ro_rt == 0 ||
1993 1.2 itojun ! (IN6_ARE_ADDR_EQUAL(&sin6->sin6_addr, &ip6->ip6_dst))) {
1994 1.2 itojun if (icmp6_reflect_rt.ro_rt) {
1995 1.2 itojun icmp6_reflect_rt.ro_rt = 0;
1996 1.2 itojun }
1997 1.2 itojun bzero(sin6, sizeof(*sin6));
1998 1.2 itojun sin6->sin6_family = PF_INET6;
1999 1.2 itojun sin6->sin6_len = sizeof(struct sockaddr_in6);
2000 1.2 itojun sin6->sin6_addr = ip6->ip6_dst;
2001 1.2 itojun
2002 1.10 itojun rtalloc((struct route *)&icmp6_reflect_rt.ro_rt);
2003 1.2 itojun }
2004 1.2 itojun
2005 1.2 itojun if (icmp6_reflect_rt.ro_rt == 0)
2006 1.2 itojun goto bad;
2007 1.2 itojun
2008 1.2 itojun if ((icmp6_reflect_rt.ro_rt->rt_flags & RTF_HOST)
2009 1.2 itojun && mtu < icmp6_reflect_rt.ro_rt->rt_ifp->if_mtu)
2010 1.2 itojun mtu = icmp6_reflect_rt.ro_rt->rt_rmx.rmx_mtu;
2011 1.2 itojun
2012 1.2 itojun if (mtu < m->m_pkthdr.len) {
2013 1.2 itojun plen -= (m->m_pkthdr.len - mtu);
2014 1.2 itojun m_adj(m, mtu - m->m_pkthdr.len);
2015 1.2 itojun }
2016 1.29 itojun #endif
2017 1.2 itojun /*
2018 1.2 itojun * If the incoming packet was addressed directly to us(i.e. unicast),
2019 1.2 itojun * use dst as the src for the reply.
2020 1.31 itojun * The IN6_IFF_NOTREADY case would be VERY rare, but is possible
2021 1.23 itojun * (for example) when we encounter an error while forwarding procedure
2022 1.23 itojun * destined to a duplicated address of ours.
2023 1.2 itojun */
2024 1.2 itojun for (ia = in6_ifaddr; ia; ia = ia->ia_next)
2025 1.2 itojun if (IN6_ARE_ADDR_EQUAL(&t, &ia->ia_addr.sin6_addr) &&
2026 1.23 itojun (ia->ia6_flags & (IN6_IFF_ANYCAST|IN6_IFF_NOTREADY)) == 0) {
2027 1.2 itojun src = &t;
2028 1.2 itojun break;
2029 1.2 itojun }
2030 1.2 itojun if (ia == NULL && IN6_IS_ADDR_LINKLOCAL(&t) && (m->m_flags & M_LOOP)) {
2031 1.2 itojun /*
2032 1.2 itojun * This is the case if the dst is our link-local address
2033 1.2 itojun * and the sender is also ourseleves.
2034 1.2 itojun */
2035 1.2 itojun src = &t;
2036 1.2 itojun }
2037 1.2 itojun
2038 1.2 itojun if (src == 0)
2039 1.2 itojun /*
2040 1.23 itojun * This case matches to multicasts, our anycast, or unicasts
2041 1.23 itojun * that we do not own. Select a source address which has the
2042 1.23 itojun * same scope.
2043 1.23 itojun * XXX: for (non link-local) multicast addresses, this might
2044 1.23 itojun * not be a good choice.
2045 1.2 itojun */
2046 1.2 itojun if ((ia = in6_ifawithscope(m->m_pkthdr.rcvif, &t)) != 0)
2047 1.2 itojun src = &IA6_SIN6(ia)->sin6_addr;
2048 1.2 itojun
2049 1.29 itojun if (src == 0)
2050 1.2 itojun goto bad;
2051 1.2 itojun
2052 1.2 itojun ip6->ip6_src = *src;
2053 1.2 itojun
2054 1.2 itojun ip6->ip6_flow = 0;
2055 1.13 itojun ip6->ip6_vfc &= ~IPV6_VERSION_MASK;
2056 1.13 itojun ip6->ip6_vfc |= IPV6_VERSION;
2057 1.2 itojun ip6->ip6_nxt = IPPROTO_ICMPV6;
2058 1.2 itojun if (m->m_pkthdr.rcvif) {
2059 1.2 itojun /* XXX: This may not be the outgoing interface */
2060 1.2 itojun ip6->ip6_hlim = nd_ifinfo[m->m_pkthdr.rcvif->if_index].chlim;
2061 1.2 itojun }
2062 1.2 itojun
2063 1.2 itojun icmp6->icmp6_cksum = 0;
2064 1.2 itojun icmp6->icmp6_cksum = in6_cksum(m, IPPROTO_ICMPV6,
2065 1.2 itojun sizeof(struct ip6_hdr), plen);
2066 1.2 itojun
2067 1.2 itojun /*
2068 1.2 itojun * xxx option handling
2069 1.2 itojun */
2070 1.2 itojun
2071 1.2 itojun m->m_flags &= ~(M_BCAST|M_MCAST);
2072 1.2 itojun #ifdef IPSEC
2073 1.26 itojun /* Don't lookup socket */
2074 1.52 itojun (void)ipsec_setsocket(m, NULL);
2075 1.2 itojun #endif /*IPSEC*/
2076 1.2 itojun
2077 1.2 itojun #ifdef COMPAT_RFC1885
2078 1.12 itojun ip6_output(m, NULL, &icmp6_reflect_rt, 0, NULL, &outif);
2079 1.2 itojun #else
2080 1.12 itojun ip6_output(m, NULL, NULL, 0, NULL, &outif);
2081 1.12 itojun #endif
2082 1.12 itojun if (outif)
2083 1.12 itojun icmp6_ifoutstat_inc(outif, type, code);
2084 1.2 itojun
2085 1.2 itojun return;
2086 1.2 itojun
2087 1.2 itojun bad:
2088 1.2 itojun m_freem(m);
2089 1.2 itojun return;
2090 1.2 itojun }
2091 1.2 itojun
2092 1.2 itojun void
2093 1.2 itojun icmp6_fasttimo()
2094 1.2 itojun {
2095 1.31 itojun
2096 1.2 itojun mld6_fasttimeo();
2097 1.2 itojun }
2098 1.2 itojun
2099 1.12 itojun static const char *
2100 1.12 itojun icmp6_redirect_diag(src6, dst6, tgt6)
2101 1.11 itojun struct in6_addr *src6;
2102 1.11 itojun struct in6_addr *dst6;
2103 1.11 itojun struct in6_addr *tgt6;
2104 1.11 itojun {
2105 1.12 itojun static char buf[1024];
2106 1.12 itojun snprintf(buf, sizeof(buf), "(src=%s dst=%s tgt=%s)",
2107 1.12 itojun ip6_sprintf(src6), ip6_sprintf(dst6), ip6_sprintf(tgt6));
2108 1.12 itojun return buf;
2109 1.11 itojun }
2110 1.11 itojun
2111 1.2 itojun void
2112 1.2 itojun icmp6_redirect_input(m, off)
2113 1.2 itojun register struct mbuf *m;
2114 1.2 itojun int off;
2115 1.2 itojun {
2116 1.2 itojun struct ifnet *ifp = m->m_pkthdr.rcvif;
2117 1.2 itojun struct ip6_hdr *ip6 = mtod(m, struct ip6_hdr *);
2118 1.23 itojun struct nd_redirect *nd_rd;
2119 1.2 itojun int icmp6len = ntohs(ip6->ip6_plen);
2120 1.2 itojun char *lladdr = NULL;
2121 1.2 itojun int lladdrlen = 0;
2122 1.2 itojun u_char *redirhdr = NULL;
2123 1.2 itojun int redirhdrlen = 0;
2124 1.2 itojun struct rtentry *rt = NULL;
2125 1.2 itojun int is_router;
2126 1.2 itojun int is_onlink;
2127 1.2 itojun struct in6_addr src6 = ip6->ip6_src;
2128 1.23 itojun struct in6_addr redtgt6;
2129 1.23 itojun struct in6_addr reddst6;
2130 1.2 itojun union nd_opts ndopts;
2131 1.2 itojun
2132 1.2 itojun if (!m || !ifp)
2133 1.2 itojun return;
2134 1.2 itojun
2135 1.2 itojun /* XXX if we are router, we don't update route by icmp6 redirect */
2136 1.2 itojun if (ip6_forwarding)
2137 1.23 itojun goto freeit;
2138 1.2 itojun if (!icmp6_rediraccept)
2139 1.23 itojun goto freeit;
2140 1.2 itojun
2141 1.23 itojun #ifndef PULLDOWN_TEST
2142 1.23 itojun IP6_EXTHDR_CHECK(m, off, icmp6len,);
2143 1.23 itojun nd_rd = (struct nd_redirect *)((caddr_t)ip6 + off);
2144 1.23 itojun #else
2145 1.23 itojun IP6_EXTHDR_GET(nd_rd, struct nd_redirect *, m, off, icmp6len);
2146 1.23 itojun if (nd_rd == NULL) {
2147 1.23 itojun icmp6stat.icp6s_tooshort++;
2148 1.23 itojun return;
2149 1.23 itojun }
2150 1.23 itojun #endif
2151 1.23 itojun redtgt6 = nd_rd->nd_rd_target;
2152 1.23 itojun reddst6 = nd_rd->nd_rd_dst;
2153 1.25 itojun
2154 1.25 itojun if (IN6_IS_ADDR_LINKLOCAL(&redtgt6))
2155 1.25 itojun redtgt6.s6_addr16[1] = htons(ifp->if_index);
2156 1.25 itojun if (IN6_IS_ADDR_LINKLOCAL(&reddst6))
2157 1.25 itojun reddst6.s6_addr16[1] = htons(ifp->if_index);
2158 1.23 itojun
2159 1.2 itojun /* validation */
2160 1.2 itojun if (!IN6_IS_ADDR_LINKLOCAL(&src6)) {
2161 1.2 itojun log(LOG_ERR,
2162 1.2 itojun "ICMP6 redirect sent from %s rejected; "
2163 1.2 itojun "must be from linklocal\n", ip6_sprintf(&src6));
2164 1.23 itojun goto freeit;
2165 1.2 itojun }
2166 1.2 itojun if (ip6->ip6_hlim != 255) {
2167 1.2 itojun log(LOG_ERR,
2168 1.2 itojun "ICMP6 redirect sent from %s rejected; "
2169 1.2 itojun "hlim=%d (must be 255)\n",
2170 1.2 itojun ip6_sprintf(&src6), ip6->ip6_hlim);
2171 1.23 itojun goto freeit;
2172 1.2 itojun }
2173 1.2 itojun {
2174 1.2 itojun /* ip6->ip6_src must be equal to gw for icmp6->icmp6_reddst */
2175 1.2 itojun struct sockaddr_in6 sin6;
2176 1.2 itojun struct in6_addr *gw6;
2177 1.2 itojun
2178 1.2 itojun bzero(&sin6, sizeof(sin6));
2179 1.2 itojun sin6.sin6_family = AF_INET6;
2180 1.2 itojun sin6.sin6_len = sizeof(struct sockaddr_in6);
2181 1.2 itojun bcopy(&reddst6, &sin6.sin6_addr, sizeof(reddst6));
2182 1.23 itojun rt = rtalloc1((struct sockaddr *)&sin6, 0);
2183 1.2 itojun if (rt) {
2184 1.43 itojun if (rt->rt_gateway == NULL ||
2185 1.43 itojun rt->rt_gateway->sa_family != AF_INET6) {
2186 1.43 itojun log(LOG_ERR,
2187 1.43 itojun "ICMP6 redirect rejected; no route "
2188 1.43 itojun "with inet6 gateway found for redirect dst: %s\n",
2189 1.43 itojun icmp6_redirect_diag(&src6, &reddst6, &redtgt6));
2190 1.43 itojun RTFREE(rt);
2191 1.43 itojun goto freeit;
2192 1.43 itojun }
2193 1.43 itojun
2194 1.2 itojun gw6 = &(((struct sockaddr_in6 *)rt->rt_gateway)->sin6_addr);
2195 1.2 itojun if (bcmp(&src6, gw6, sizeof(struct in6_addr)) != 0) {
2196 1.2 itojun log(LOG_ERR,
2197 1.12 itojun "ICMP6 redirect rejected; "
2198 1.12 itojun "not equal to gw-for-src=%s (must be same): "
2199 1.12 itojun "%s\n",
2200 1.12 itojun ip6_sprintf(gw6),
2201 1.12 itojun icmp6_redirect_diag(&src6, &reddst6, &redtgt6));
2202 1.2 itojun RTFREE(rt);
2203 1.23 itojun goto freeit;
2204 1.2 itojun }
2205 1.2 itojun } else {
2206 1.2 itojun log(LOG_ERR,
2207 1.12 itojun "ICMP6 redirect rejected; "
2208 1.12 itojun "no route found for redirect dst: %s\n",
2209 1.12 itojun icmp6_redirect_diag(&src6, &reddst6, &redtgt6));
2210 1.23 itojun goto freeit;
2211 1.2 itojun }
2212 1.2 itojun RTFREE(rt);
2213 1.2 itojun rt = NULL;
2214 1.2 itojun }
2215 1.2 itojun if (IN6_IS_ADDR_MULTICAST(&reddst6)) {
2216 1.2 itojun log(LOG_ERR,
2217 1.12 itojun "ICMP6 redirect rejected; "
2218 1.12 itojun "redirect dst must be unicast: %s\n",
2219 1.12 itojun icmp6_redirect_diag(&src6, &reddst6, &redtgt6));
2220 1.23 itojun goto freeit;
2221 1.2 itojun }
2222 1.2 itojun
2223 1.2 itojun is_router = is_onlink = 0;
2224 1.2 itojun if (IN6_IS_ADDR_LINKLOCAL(&redtgt6))
2225 1.2 itojun is_router = 1; /* router case */
2226 1.2 itojun if (bcmp(&redtgt6, &reddst6, sizeof(redtgt6)) == 0)
2227 1.2 itojun is_onlink = 1; /* on-link destination case */
2228 1.2 itojun if (!is_router && !is_onlink) {
2229 1.2 itojun log(LOG_ERR,
2230 1.12 itojun "ICMP6 redirect rejected; "
2231 1.12 itojun "neither router case nor onlink case: %s\n",
2232 1.12 itojun icmp6_redirect_diag(&src6, &reddst6, &redtgt6));
2233 1.23 itojun goto freeit;
2234 1.2 itojun }
2235 1.2 itojun /* validation passed */
2236 1.2 itojun
2237 1.2 itojun icmp6len -= sizeof(*nd_rd);
2238 1.2 itojun nd6_option_init(nd_rd + 1, icmp6len, &ndopts);
2239 1.2 itojun if (nd6_options(&ndopts) < 0) {
2240 1.2 itojun log(LOG_INFO, "icmp6_redirect_input: "
2241 1.12 itojun "invalid ND option, rejected: %s\n",
2242 1.12 itojun icmp6_redirect_diag(&src6, &reddst6, &redtgt6));
2243 1.23 itojun goto freeit;
2244 1.2 itojun }
2245 1.2 itojun
2246 1.2 itojun if (ndopts.nd_opts_tgt_lladdr) {
2247 1.2 itojun lladdr = (char *)(ndopts.nd_opts_tgt_lladdr + 1);
2248 1.2 itojun lladdrlen = ndopts.nd_opts_tgt_lladdr->nd_opt_len << 3;
2249 1.2 itojun }
2250 1.2 itojun
2251 1.2 itojun if (ndopts.nd_opts_rh) {
2252 1.2 itojun redirhdrlen = ndopts.nd_opts_rh->nd_opt_rh_len;
2253 1.2 itojun redirhdr = (u_char *)(ndopts.nd_opts_rh + 1); /* xxx */
2254 1.2 itojun }
2255 1.2 itojun
2256 1.2 itojun if (lladdr && ((ifp->if_addrlen + 2 + 7) & ~7) != lladdrlen) {
2257 1.2 itojun log(LOG_INFO,
2258 1.2 itojun "icmp6_redirect_input: lladdrlen mismatch for %s "
2259 1.12 itojun "(if %d, icmp6 packet %d): %s\n",
2260 1.12 itojun ip6_sprintf(&redtgt6), ifp->if_addrlen, lladdrlen - 2,
2261 1.12 itojun icmp6_redirect_diag(&src6, &reddst6, &redtgt6));
2262 1.2 itojun }
2263 1.2 itojun
2264 1.2 itojun /* RFC 2461 8.3 */
2265 1.10 itojun nd6_cache_lladdr(ifp, &redtgt6, lladdr, lladdrlen, ND_REDIRECT,
2266 1.10 itojun is_onlink ? ND_REDIRECT_ONLINK : ND_REDIRECT_ROUTER);
2267 1.2 itojun
2268 1.2 itojun if (!is_onlink) { /* better router case. perform rtredirect. */
2269 1.2 itojun /* perform rtredirect */
2270 1.2 itojun struct sockaddr_in6 sdst;
2271 1.2 itojun struct sockaddr_in6 sgw;
2272 1.2 itojun struct sockaddr_in6 ssrc;
2273 1.2 itojun
2274 1.2 itojun bzero(&sdst, sizeof(sdst));
2275 1.2 itojun bzero(&sgw, sizeof(sgw));
2276 1.2 itojun bzero(&ssrc, sizeof(ssrc));
2277 1.2 itojun sdst.sin6_family = sgw.sin6_family = ssrc.sin6_family = AF_INET6;
2278 1.2 itojun sdst.sin6_len = sgw.sin6_len = ssrc.sin6_len =
2279 1.2 itojun sizeof(struct sockaddr_in6);
2280 1.2 itojun bcopy(&redtgt6, &sgw.sin6_addr, sizeof(struct in6_addr));
2281 1.2 itojun bcopy(&reddst6, &sdst.sin6_addr, sizeof(struct in6_addr));
2282 1.2 itojun bcopy(&src6, &ssrc.sin6_addr, sizeof(struct in6_addr));
2283 1.2 itojun rtredirect((struct sockaddr *)&sdst, (struct sockaddr *)&sgw,
2284 1.2 itojun (struct sockaddr *)NULL, RTF_GATEWAY | RTF_HOST,
2285 1.2 itojun (struct sockaddr *)&ssrc,
2286 1.2 itojun (struct rtentry **)NULL
2287 1.2 itojun );
2288 1.2 itojun }
2289 1.2 itojun /* finally update cached route in each socket via pfctlinput */
2290 1.12 itojun {
2291 1.12 itojun struct sockaddr_in6 sdst;
2292 1.12 itojun #if 1
2293 1.12 itojun #else
2294 1.12 itojun struct ip6protosw *pr;
2295 1.12 itojun #endif
2296 1.2 itojun
2297 1.12 itojun bzero(&sdst, sizeof(sdst));
2298 1.12 itojun sdst.sin6_family = AF_INET6;
2299 1.12 itojun sdst.sin6_len = sizeof(struct sockaddr_in6);
2300 1.12 itojun bcopy(&reddst6, &sdst.sin6_addr, sizeof(struct in6_addr));
2301 1.12 itojun #if 1
2302 1.12 itojun pfctlinput(PRC_REDIRECT_HOST, (struct sockaddr *)&sdst);
2303 1.12 itojun #else
2304 1.12 itojun /*
2305 1.12 itojun * do not use pfctlinput() here, we have different prototype for
2306 1.12 itojun * xx_ctlinput() in ip6proto.
2307 1.12 itojun */
2308 1.12 itojun for (pr = (struct ip6protosw *)inet6domain.dom_protosw;
2309 1.12 itojun pr < (struct ip6protosw *)inet6domain.dom_protoswNPROTOSW;
2310 1.12 itojun pr++) {
2311 1.12 itojun if (pr->pr_ctlinput) {
2312 1.12 itojun (*pr->pr_ctlinput)(PRC_REDIRECT_HOST,
2313 1.12 itojun (struct sockaddr *)&sdst, NULL, NULL, 0);
2314 1.12 itojun }
2315 1.12 itojun }
2316 1.12 itojun #endif
2317 1.2 itojun #ifdef IPSEC
2318 1.12 itojun key_sa_routechange((struct sockaddr *)&sdst);
2319 1.2 itojun #endif
2320 1.12 itojun }
2321 1.23 itojun
2322 1.23 itojun freeit:
2323 1.23 itojun m_freem(m);
2324 1.2 itojun }
2325 1.2 itojun
2326 1.2 itojun void
2327 1.2 itojun icmp6_redirect_output(m0, rt)
2328 1.2 itojun struct mbuf *m0;
2329 1.2 itojun struct rtentry *rt;
2330 1.2 itojun {
2331 1.2 itojun struct ifnet *ifp; /* my outgoing interface */
2332 1.2 itojun struct in6_addr *ifp_ll6;
2333 1.2 itojun struct in6_addr *router_ll6;
2334 1.2 itojun struct ip6_hdr *sip6; /* m0 as struct ip6_hdr */
2335 1.2 itojun struct mbuf *m = NULL; /* newly allocated one */
2336 1.2 itojun struct ip6_hdr *ip6; /* m as struct ip6_hdr */
2337 1.2 itojun struct nd_redirect *nd_rd;
2338 1.2 itojun size_t maxlen;
2339 1.2 itojun u_char *p;
2340 1.12 itojun struct ifnet *outif = NULL;
2341 1.29 itojun struct sockaddr_in6 src_sa;
2342 1.2 itojun
2343 1.35 itojun icmp6_errcount(&icmp6stat.icp6s_outerrhist, ND_REDIRECT, 0);
2344 1.35 itojun
2345 1.2 itojun /* if we are not router, we don't send icmp6 redirect */
2346 1.2 itojun if (!ip6_forwarding || ip6_accept_rtadv)
2347 1.2 itojun goto fail;
2348 1.2 itojun
2349 1.2 itojun /* sanity check */
2350 1.2 itojun if (!m0 || !rt || !(rt->rt_flags & RTF_UP) || !(ifp = rt->rt_ifp))
2351 1.2 itojun goto fail;
2352 1.5 itojun
2353 1.5 itojun /*
2354 1.5 itojun * Address check:
2355 1.5 itojun * the source address must identify a neighbor, and
2356 1.5 itojun * the destination address must not be a multicast address
2357 1.5 itojun * [RFC 2461, sec 8.2]
2358 1.5 itojun */
2359 1.2 itojun sip6 = mtod(m0, struct ip6_hdr *);
2360 1.29 itojun bzero(&src_sa, sizeof(src_sa));
2361 1.29 itojun src_sa.sin6_family = AF_INET6;
2362 1.29 itojun src_sa.sin6_len = sizeof(src_sa);
2363 1.29 itojun src_sa.sin6_addr = sip6->ip6_src;
2364 1.29 itojun /* we don't currently use sin6_scope_id, but eventually use it */
2365 1.29 itojun src_sa.sin6_scope_id = in6_addr2scopeid(ifp, &sip6->ip6_src);
2366 1.29 itojun if (nd6_is_addr_neighbor(&src_sa, ifp) == 0)
2367 1.5 itojun goto fail;
2368 1.2 itojun if (IN6_IS_ADDR_MULTICAST(&sip6->ip6_dst))
2369 1.2 itojun goto fail; /* what should we do here? */
2370 1.2 itojun
2371 1.2 itojun /* rate limit */
2372 1.2 itojun if (icmp6_ratelimit(&sip6->ip6_src, ND_REDIRECT, 0))
2373 1.2 itojun goto fail;
2374 1.2 itojun
2375 1.2 itojun /*
2376 1.2 itojun * Since we are going to append up to 1280 bytes (= IPV6_MMTU),
2377 1.2 itojun * we almost always ask for an mbuf cluster for simplicity.
2378 1.2 itojun * (MHLEN < IPV6_MMTU is almost always true)
2379 1.2 itojun */
2380 1.23 itojun #if IPV6_MMTU >= MCLBYTES
2381 1.23 itojun # error assumption failed about IPV6_MMTU and MCLBYTES
2382 1.23 itojun #endif
2383 1.2 itojun MGETHDR(m, M_DONTWAIT, MT_HEADER);
2384 1.23 itojun if (m && IPV6_MMTU >= MHLEN)
2385 1.23 itojun MCLGET(m, M_DONTWAIT);
2386 1.2 itojun if (!m)
2387 1.2 itojun goto fail;
2388 1.42 itojun m->m_len = 0;
2389 1.42 itojun maxlen = M_TRAILINGSPACE(m);
2390 1.2 itojun maxlen = min(IPV6_MMTU, maxlen);
2391 1.2 itojun /* just for safety */
2392 1.23 itojun if (maxlen < sizeof(struct ip6_hdr) + sizeof(struct icmp6_hdr) +
2393 1.23 itojun ((sizeof(struct nd_opt_hdr) + ifp->if_addrlen + 7) & ~7)) {
2394 1.2 itojun goto fail;
2395 1.23 itojun }
2396 1.2 itojun
2397 1.2 itojun {
2398 1.2 itojun /* get ip6 linklocal address for ifp(my outgoing interface). */
2399 1.23 itojun struct in6_ifaddr *ia;
2400 1.23 itojun if ((ia = in6ifa_ifpforlinklocal(ifp,
2401 1.23 itojun IN6_IFF_NOTREADY|
2402 1.23 itojun IN6_IFF_ANYCAST)) == NULL)
2403 1.2 itojun goto fail;
2404 1.2 itojun ifp_ll6 = &ia->ia_addr.sin6_addr;
2405 1.2 itojun }
2406 1.2 itojun
2407 1.2 itojun /* get ip6 linklocal address for the router. */
2408 1.2 itojun if (rt->rt_gateway && (rt->rt_flags & RTF_GATEWAY)) {
2409 1.2 itojun struct sockaddr_in6 *sin6;
2410 1.2 itojun sin6 = (struct sockaddr_in6 *)rt->rt_gateway;
2411 1.2 itojun router_ll6 = &sin6->sin6_addr;
2412 1.2 itojun if (!IN6_IS_ADDR_LINKLOCAL(router_ll6))
2413 1.2 itojun router_ll6 = (struct in6_addr *)NULL;
2414 1.2 itojun } else
2415 1.2 itojun router_ll6 = (struct in6_addr *)NULL;
2416 1.2 itojun
2417 1.2 itojun /* ip6 */
2418 1.2 itojun ip6 = mtod(m, struct ip6_hdr *);
2419 1.2 itojun ip6->ip6_flow = 0;
2420 1.13 itojun ip6->ip6_vfc &= ~IPV6_VERSION_MASK;
2421 1.13 itojun ip6->ip6_vfc |= IPV6_VERSION;
2422 1.2 itojun /* ip6->ip6_plen will be set later */
2423 1.2 itojun ip6->ip6_nxt = IPPROTO_ICMPV6;
2424 1.2 itojun ip6->ip6_hlim = 255;
2425 1.2 itojun /* ip6->ip6_src must be linklocal addr for my outgoing if. */
2426 1.2 itojun bcopy(ifp_ll6, &ip6->ip6_src, sizeof(struct in6_addr));
2427 1.2 itojun bcopy(&sip6->ip6_src, &ip6->ip6_dst, sizeof(struct in6_addr));
2428 1.2 itojun
2429 1.2 itojun /* ND Redirect */
2430 1.2 itojun nd_rd = (struct nd_redirect *)(ip6 + 1);
2431 1.2 itojun nd_rd->nd_rd_type = ND_REDIRECT;
2432 1.2 itojun nd_rd->nd_rd_code = 0;
2433 1.2 itojun nd_rd->nd_rd_reserved = 0;
2434 1.2 itojun if (rt->rt_flags & RTF_GATEWAY) {
2435 1.2 itojun /*
2436 1.2 itojun * nd_rd->nd_rd_target must be a link-local address in
2437 1.2 itojun * better router cases.
2438 1.2 itojun */
2439 1.2 itojun if (!router_ll6)
2440 1.2 itojun goto fail;
2441 1.2 itojun bcopy(router_ll6, &nd_rd->nd_rd_target,
2442 1.2 itojun sizeof(nd_rd->nd_rd_target));
2443 1.2 itojun bcopy(&sip6->ip6_dst, &nd_rd->nd_rd_dst,
2444 1.2 itojun sizeof(nd_rd->nd_rd_dst));
2445 1.2 itojun } else {
2446 1.2 itojun /* make sure redtgt == reddst */
2447 1.2 itojun bcopy(&sip6->ip6_dst, &nd_rd->nd_rd_target,
2448 1.2 itojun sizeof(nd_rd->nd_rd_target));
2449 1.2 itojun bcopy(&sip6->ip6_dst, &nd_rd->nd_rd_dst,
2450 1.2 itojun sizeof(nd_rd->nd_rd_dst));
2451 1.2 itojun }
2452 1.2 itojun
2453 1.2 itojun p = (u_char *)(nd_rd + 1);
2454 1.2 itojun
2455 1.2 itojun if (!router_ll6)
2456 1.2 itojun goto nolladdropt;
2457 1.2 itojun
2458 1.2 itojun {
2459 1.2 itojun /* target lladdr option */
2460 1.2 itojun struct rtentry *rt_router = NULL;
2461 1.2 itojun int len;
2462 1.2 itojun struct sockaddr_dl *sdl;
2463 1.2 itojun struct nd_opt_hdr *nd_opt;
2464 1.2 itojun char *lladdr;
2465 1.2 itojun
2466 1.2 itojun rt_router = nd6_lookup(router_ll6, 0, ifp);
2467 1.2 itojun if (!rt_router)
2468 1.2 itojun goto nolladdropt;
2469 1.23 itojun len = sizeof(*nd_opt) + ifp->if_addrlen;
2470 1.23 itojun len = (len + 7) & ~7; /*round by 8*/
2471 1.23 itojun /* safety check */
2472 1.23 itojun if (len + (p - (u_char *)ip6) > maxlen)
2473 1.23 itojun goto nolladdropt;
2474 1.12 itojun if (!(rt_router->rt_flags & RTF_GATEWAY) &&
2475 1.12 itojun (rt_router->rt_flags & RTF_LLINFO) &&
2476 1.12 itojun (rt_router->rt_gateway->sa_family == AF_LINK) &&
2477 1.12 itojun (sdl = (struct sockaddr_dl *)rt_router->rt_gateway) &&
2478 1.12 itojun sdl->sdl_alen) {
2479 1.2 itojun nd_opt = (struct nd_opt_hdr *)p;
2480 1.2 itojun nd_opt->nd_opt_type = ND_OPT_TARGET_LINKADDR;
2481 1.2 itojun nd_opt->nd_opt_len = len >> 3;
2482 1.2 itojun lladdr = (char *)(nd_opt + 1);
2483 1.2 itojun bcopy(LLADDR(sdl), lladdr, ifp->if_addrlen);
2484 1.23 itojun p += len;
2485 1.2 itojun }
2486 1.2 itojun }
2487 1.2 itojun nolladdropt:;
2488 1.2 itojun
2489 1.2 itojun m->m_pkthdr.len = m->m_len = p - (u_char *)ip6;
2490 1.2 itojun
2491 1.2 itojun /* just to be safe */
2492 1.2 itojun if (m0->m_flags & M_DECRYPTED)
2493 1.2 itojun goto noredhdropt;
2494 1.23 itojun if (p - (u_char *)ip6 > maxlen)
2495 1.23 itojun goto noredhdropt;
2496 1.2 itojun
2497 1.2 itojun {
2498 1.2 itojun /* redirected header option */
2499 1.2 itojun int len;
2500 1.2 itojun struct nd_opt_rd_hdr *nd_opt_rh;
2501 1.2 itojun
2502 1.2 itojun /*
2503 1.2 itojun * compute the maximum size for icmp6 redirect header option.
2504 1.2 itojun * XXX room for auth header?
2505 1.2 itojun */
2506 1.2 itojun len = maxlen - (p - (u_char *)ip6);
2507 1.2 itojun len &= ~7;
2508 1.2 itojun
2509 1.2 itojun /* This is just for simplicity. */
2510 1.2 itojun if (m0->m_pkthdr.len != m0->m_len) {
2511 1.2 itojun if (m0->m_next) {
2512 1.2 itojun m_freem(m0->m_next);
2513 1.2 itojun m0->m_next = NULL;
2514 1.2 itojun }
2515 1.2 itojun m0->m_pkthdr.len = m0->m_len;
2516 1.2 itojun }
2517 1.2 itojun
2518 1.2 itojun /*
2519 1.2 itojun * Redirected header option spec (RFC2461 4.6.3) talks nothing
2520 1.12 itojun * about padding/truncate rule for the original IP packet.
2521 1.2 itojun * From the discussion on IPv6imp in Feb 1999, the consensus was:
2522 1.2 itojun * - "attach as much as possible" is the goal
2523 1.2 itojun * - pad if not aligned (original size can be guessed by original
2524 1.2 itojun * ip6 header)
2525 1.2 itojun * Following code adds the padding if it is simple enough,
2526 1.2 itojun * and truncates if not.
2527 1.2 itojun */
2528 1.2 itojun if (m0->m_next || m0->m_pkthdr.len != m0->m_len)
2529 1.2 itojun panic("assumption failed in %s:%d\n", __FILE__, __LINE__);
2530 1.2 itojun
2531 1.2 itojun if (len - sizeof(*nd_opt_rh) < m0->m_pkthdr.len) {
2532 1.2 itojun /* not enough room, truncate */
2533 1.2 itojun m0->m_pkthdr.len = m0->m_len = len - sizeof(*nd_opt_rh);
2534 1.2 itojun } else {
2535 1.2 itojun /* enough room, pad or truncate */
2536 1.2 itojun size_t extra;
2537 1.2 itojun
2538 1.2 itojun extra = m0->m_pkthdr.len % 8;
2539 1.2 itojun if (extra) {
2540 1.2 itojun /* pad if easy enough, truncate if not */
2541 1.2 itojun if (8 - extra <= M_TRAILINGSPACE(m0)) {
2542 1.2 itojun /* pad */
2543 1.2 itojun m0->m_len += (8 - extra);
2544 1.2 itojun m0->m_pkthdr.len += (8 - extra);
2545 1.2 itojun } else {
2546 1.2 itojun /* truncate */
2547 1.2 itojun m0->m_pkthdr.len -= extra;
2548 1.2 itojun m0->m_len -= extra;
2549 1.2 itojun }
2550 1.2 itojun }
2551 1.2 itojun len = m0->m_pkthdr.len + sizeof(*nd_opt_rh);
2552 1.2 itojun m0->m_pkthdr.len = m0->m_len = len - sizeof(*nd_opt_rh);
2553 1.2 itojun }
2554 1.2 itojun
2555 1.2 itojun nd_opt_rh = (struct nd_opt_rd_hdr *)p;
2556 1.2 itojun bzero(nd_opt_rh, sizeof(*nd_opt_rh));
2557 1.2 itojun nd_opt_rh->nd_opt_rh_type = ND_OPT_REDIRECTED_HEADER;
2558 1.2 itojun nd_opt_rh->nd_opt_rh_len = len >> 3;
2559 1.2 itojun p += sizeof(*nd_opt_rh);
2560 1.2 itojun m->m_pkthdr.len = m->m_len = p - (u_char *)ip6;
2561 1.2 itojun
2562 1.2 itojun /* connect m0 to m */
2563 1.2 itojun m->m_next = m0;
2564 1.2 itojun m->m_pkthdr.len = m->m_len + m0->m_len;
2565 1.2 itojun }
2566 1.2 itojun noredhdropt:;
2567 1.2 itojun
2568 1.2 itojun if (IN6_IS_ADDR_LINKLOCAL(&sip6->ip6_src))
2569 1.2 itojun sip6->ip6_src.s6_addr16[1] = 0;
2570 1.2 itojun if (IN6_IS_ADDR_LINKLOCAL(&sip6->ip6_dst))
2571 1.2 itojun sip6->ip6_dst.s6_addr16[1] = 0;
2572 1.2 itojun #if 0
2573 1.2 itojun if (IN6_IS_ADDR_LINKLOCAL(&ip6->ip6_src))
2574 1.2 itojun ip6->ip6_src.s6_addr16[1] = 0;
2575 1.2 itojun if (IN6_IS_ADDR_LINKLOCAL(&ip6->ip6_dst))
2576 1.2 itojun ip6->ip6_dst.s6_addr16[1] = 0;
2577 1.2 itojun #endif
2578 1.2 itojun if (IN6_IS_ADDR_LINKLOCAL(&nd_rd->nd_rd_target))
2579 1.2 itojun nd_rd->nd_rd_target.s6_addr16[1] = 0;
2580 1.2 itojun if (IN6_IS_ADDR_LINKLOCAL(&nd_rd->nd_rd_dst))
2581 1.2 itojun nd_rd->nd_rd_dst.s6_addr16[1] = 0;
2582 1.2 itojun
2583 1.2 itojun ip6->ip6_plen = htons(m->m_pkthdr.len - sizeof(struct ip6_hdr));
2584 1.2 itojun
2585 1.2 itojun nd_rd->nd_rd_cksum = 0;
2586 1.2 itojun nd_rd->nd_rd_cksum
2587 1.2 itojun = in6_cksum(m, IPPROTO_ICMPV6, sizeof(*ip6), ntohs(ip6->ip6_plen));
2588 1.2 itojun
2589 1.2 itojun /* send the packet to outside... */
2590 1.2 itojun #ifdef IPSEC
2591 1.26 itojun /* Don't lookup socket */
2592 1.52 itojun (void)ipsec_setsocket(m, NULL);
2593 1.2 itojun #endif /*IPSEC*/
2594 1.12 itojun ip6_output(m, NULL, NULL, 0, NULL, &outif);
2595 1.12 itojun if (outif) {
2596 1.12 itojun icmp6_ifstat_inc(outif, ifs6_out_msg);
2597 1.12 itojun icmp6_ifstat_inc(outif, ifs6_out_redirect);
2598 1.12 itojun }
2599 1.2 itojun icmp6stat.icp6s_outhist[ND_REDIRECT]++;
2600 1.2 itojun
2601 1.2 itojun return;
2602 1.2 itojun
2603 1.2 itojun fail:
2604 1.2 itojun if (m)
2605 1.2 itojun m_freem(m);
2606 1.2 itojun if (m0)
2607 1.2 itojun m_freem(m0);
2608 1.2 itojun }
2609 1.2 itojun
2610 1.2 itojun /*
2611 1.2 itojun * ICMPv6 socket option processing.
2612 1.2 itojun */
2613 1.2 itojun int
2614 1.2 itojun icmp6_ctloutput(op, so, level, optname, mp)
2615 1.2 itojun int op;
2616 1.2 itojun struct socket *so;
2617 1.2 itojun int level, optname;
2618 1.2 itojun struct mbuf **mp;
2619 1.2 itojun {
2620 1.2 itojun register struct in6pcb *in6p = sotoin6pcb(so);
2621 1.2 itojun register struct mbuf *m = *mp;
2622 1.2 itojun int error = 0;
2623 1.2 itojun
2624 1.2 itojun if (level != IPPROTO_ICMPV6) {
2625 1.2 itojun error = EINVAL;
2626 1.2 itojun if (op == PRCO_SETOPT && m)
2627 1.2 itojun (void)m_free(m);
2628 1.2 itojun } else switch(op) {
2629 1.2 itojun case PRCO_SETOPT:
2630 1.2 itojun switch (optname) {
2631 1.2 itojun case ICMP6_FILTER:
2632 1.2 itojun {
2633 1.2 itojun struct icmp6_filter *p;
2634 1.2 itojun
2635 1.2 itojun p = mtod(m, struct icmp6_filter *);
2636 1.2 itojun if (!p || !in6p->in6p_icmp6filt) {
2637 1.2 itojun error = EINVAL;
2638 1.2 itojun break;
2639 1.2 itojun }
2640 1.2 itojun bcopy(p, in6p->in6p_icmp6filt,
2641 1.2 itojun sizeof(struct icmp6_filter));
2642 1.2 itojun error = 0;
2643 1.2 itojun break;
2644 1.2 itojun }
2645 1.2 itojun
2646 1.2 itojun default:
2647 1.2 itojun error = ENOPROTOOPT;
2648 1.2 itojun break;
2649 1.2 itojun }
2650 1.2 itojun if (m)
2651 1.2 itojun (void)m_free(m);
2652 1.2 itojun break;
2653 1.2 itojun
2654 1.2 itojun case PRCO_GETOPT:
2655 1.2 itojun switch (optname) {
2656 1.2 itojun case ICMP6_FILTER:
2657 1.2 itojun {
2658 1.2 itojun struct icmp6_filter *p;
2659 1.2 itojun
2660 1.15 itojun if (!in6p->in6p_icmp6filt) {
2661 1.2 itojun error = EINVAL;
2662 1.2 itojun break;
2663 1.2 itojun }
2664 1.15 itojun *mp = m = m_get(M_WAIT, MT_SOOPTS);
2665 1.15 itojun m->m_len = sizeof(struct icmp6_filter);
2666 1.15 itojun p = mtod(m, struct icmp6_filter *);
2667 1.2 itojun bcopy(in6p->in6p_icmp6filt, p,
2668 1.2 itojun sizeof(struct icmp6_filter));
2669 1.2 itojun error = 0;
2670 1.2 itojun break;
2671 1.2 itojun }
2672 1.2 itojun
2673 1.2 itojun default:
2674 1.2 itojun error = ENOPROTOOPT;
2675 1.2 itojun break;
2676 1.2 itojun }
2677 1.2 itojun break;
2678 1.2 itojun }
2679 1.2 itojun
2680 1.2 itojun return(error);
2681 1.2 itojun }
2682 1.2 itojun
2683 1.2 itojun /*
2684 1.2 itojun * Perform rate limit check.
2685 1.2 itojun * Returns 0 if it is okay to send the icmp6 packet.
2686 1.2 itojun * Returns 1 if the router SHOULD NOT send this icmp6 packet due to rate
2687 1.2 itojun * limitation.
2688 1.35 itojun *
2689 1.2 itojun * XXX per-destination/type check necessary?
2690 1.2 itojun */
2691 1.2 itojun static int
2692 1.2 itojun icmp6_ratelimit(dst, type, code)
2693 1.2 itojun const struct in6_addr *dst; /* not used at this moment */
2694 1.2 itojun const int type; /* not used at this moment */
2695 1.2 itojun const int code; /* not used at this moment */
2696 1.2 itojun {
2697 1.35 itojun int ret;
2698 1.35 itojun
2699 1.35 itojun ret = 0; /*okay to send*/
2700 1.2 itojun
2701 1.35 itojun /* PPS limit */
2702 1.37 itojun if (!ppsratecheck(&icmp6errppslim_last, &icmp6errpps_count,
2703 1.37 itojun icmp6errppslim)) {
2704 1.37 itojun /* The packet is subject to rate limit */
2705 1.35 itojun ret++;
2706 1.35 itojun }
2707 1.35 itojun
2708 1.35 itojun return ret;
2709 1.2 itojun }
2710 1.8 itojun
2711 1.8 itojun static struct rtentry *
2712 1.8 itojun icmp6_mtudisc_clone(dst)
2713 1.8 itojun struct sockaddr *dst;
2714 1.8 itojun {
2715 1.8 itojun struct rtentry *rt;
2716 1.8 itojun int error;
2717 1.8 itojun
2718 1.8 itojun rt = rtalloc1(dst, 1);
2719 1.8 itojun if (rt == 0)
2720 1.8 itojun return NULL;
2721 1.29 itojun
2722 1.8 itojun /* If we didn't get a host route, allocate one */
2723 1.8 itojun if ((rt->rt_flags & RTF_HOST) == 0) {
2724 1.8 itojun struct rtentry *nrt;
2725 1.8 itojun
2726 1.29 itojun error = rtrequest((int) RTM_ADD, dst,
2727 1.8 itojun (struct sockaddr *) rt->rt_gateway,
2728 1.29 itojun (struct sockaddr *) 0,
2729 1.8 itojun RTF_GATEWAY | RTF_HOST | RTF_DYNAMIC, &nrt);
2730 1.8 itojun if (error) {
2731 1.8 itojun rtfree(rt);
2732 1.8 itojun rtfree(nrt);
2733 1.8 itojun return NULL;
2734 1.8 itojun }
2735 1.8 itojun nrt->rt_rmx = rt->rt_rmx;
2736 1.8 itojun rtfree(rt);
2737 1.8 itojun rt = nrt;
2738 1.8 itojun }
2739 1.8 itojun error = rt_timer_add(rt, icmp6_mtudisc_timeout,
2740 1.8 itojun icmp6_mtudisc_timeout_q);
2741 1.8 itojun if (error) {
2742 1.8 itojun rtfree(rt);
2743 1.8 itojun return NULL;
2744 1.8 itojun }
2745 1.8 itojun
2746 1.8 itojun return rt; /* caller need to call rtfree() */
2747 1.8 itojun }
2748 1.8 itojun
2749 1.8 itojun static void
2750 1.8 itojun icmp6_mtudisc_timeout(rt, r)
2751 1.8 itojun struct rtentry *rt;
2752 1.8 itojun struct rttimer *r;
2753 1.8 itojun {
2754 1.8 itojun if (rt == NULL)
2755 1.8 itojun panic("icmp6_mtudisc_timeout: bad route to timeout");
2756 1.29 itojun if ((rt->rt_flags & (RTF_DYNAMIC | RTF_HOST)) ==
2757 1.8 itojun (RTF_DYNAMIC | RTF_HOST)) {
2758 1.8 itojun rtrequest((int) RTM_DELETE, (struct sockaddr *)rt_key(rt),
2759 1.8 itojun rt->rt_gateway, rt_mask(rt), rt->rt_flags, 0);
2760 1.8 itojun } else {
2761 1.8 itojun if ((rt->rt_rmx.rmx_locks & RTV_MTU) == 0) {
2762 1.8 itojun rt->rt_rmx.rmx_mtu = 0;
2763 1.8 itojun }
2764 1.8 itojun }
2765 1.8 itojun }
2766 1.2 itojun
2767 1.34 mrg #include <uvm/uvm_extern.h>
2768 1.2 itojun #include <sys/sysctl.h>
2769 1.34 mrg
2770 1.2 itojun int
2771 1.2 itojun icmp6_sysctl(name, namelen, oldp, oldlenp, newp, newlen)
2772 1.2 itojun int *name;
2773 1.2 itojun u_int namelen;
2774 1.2 itojun void *oldp;
2775 1.2 itojun size_t *oldlenp;
2776 1.2 itojun void *newp;
2777 1.2 itojun size_t newlen;
2778 1.2 itojun {
2779 1.2 itojun
2780 1.2 itojun /* All sysctl names at this level are terminal. */
2781 1.2 itojun if (namelen != 1)
2782 1.2 itojun return ENOTDIR;
2783 1.2 itojun
2784 1.2 itojun switch (name[0]) {
2785 1.2 itojun
2786 1.2 itojun case ICMPV6CTL_REDIRACCEPT:
2787 1.2 itojun return sysctl_int(oldp, oldlenp, newp, newlen,
2788 1.2 itojun &icmp6_rediraccept);
2789 1.2 itojun case ICMPV6CTL_REDIRTIMEOUT:
2790 1.2 itojun return sysctl_int(oldp, oldlenp, newp, newlen,
2791 1.2 itojun &icmp6_redirtimeout);
2792 1.2 itojun case ICMPV6CTL_STATS:
2793 1.2 itojun return sysctl_rdstruct(oldp, oldlenp, newp,
2794 1.2 itojun &icmp6stat, sizeof(icmp6stat));
2795 1.2 itojun case ICMPV6CTL_ND6_PRUNE:
2796 1.2 itojun return sysctl_int(oldp, oldlenp, newp, newlen, &nd6_prune);
2797 1.2 itojun case ICMPV6CTL_ND6_DELAY:
2798 1.2 itojun return sysctl_int(oldp, oldlenp, newp, newlen, &nd6_delay);
2799 1.2 itojun case ICMPV6CTL_ND6_UMAXTRIES:
2800 1.2 itojun return sysctl_int(oldp, oldlenp, newp, newlen, &nd6_umaxtries);
2801 1.2 itojun case ICMPV6CTL_ND6_MMAXTRIES:
2802 1.2 itojun return sysctl_int(oldp, oldlenp, newp, newlen, &nd6_mmaxtries);
2803 1.2 itojun case ICMPV6CTL_ND6_USELOOPBACK:
2804 1.2 itojun return sysctl_int(oldp, oldlenp, newp, newlen,
2805 1.2 itojun &nd6_useloopback);
2806 1.14 itojun case ICMPV6CTL_NODEINFO:
2807 1.14 itojun return sysctl_int(oldp, oldlenp, newp, newlen, &icmp6_nodeinfo);
2808 1.35 itojun case ICMPV6CTL_ERRPPSLIMIT:
2809 1.35 itojun return sysctl_int(oldp, oldlenp, newp, newlen, &icmp6errppslim);
2810 1.35 itojun case ICMPV6CTL_ND6_MAXNUDHINT:
2811 1.35 itojun return sysctl_int(oldp, oldlenp, newp, newlen,
2812 1.35 itojun &nd6_maxnudhint);
2813 1.48 itojun case ICMPV6CTL_MTUDISC_HIWAT:
2814 1.48 itojun return sysctl_int(oldp, oldlenp, newp, newlen,
2815 1.48 itojun &icmp6_mtudisc_hiwat);
2816 1.48 itojun case ICMPV6CTL_MTUDISC_LOWAT:
2817 1.48 itojun return sysctl_int(oldp, oldlenp, newp, newlen,
2818 1.48 itojun &icmp6_mtudisc_lowat);
2819 1.2 itojun default:
2820 1.2 itojun return ENOPROTOOPT;
2821 1.2 itojun }
2822 1.2 itojun /* NOTREACHED */
2823 1.2 itojun }
2824