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