Home | History | Annotate | Line # | Download | only in netinet6
icmp6.c revision 1.8
      1  1.8   itojun /*	$NetBSD: icmp6.c,v 1.8 1999/07/22 12:56:57 itojun Exp $	*/
      2  1.3  thorpej 
      3  1.2   itojun /*
      4  1.2   itojun  * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project.
      5  1.2   itojun  * All rights reserved.
      6  1.2   itojun  *
      7  1.2   itojun  * Redistribution and use in source and binary forms, with or without
      8  1.2   itojun  * modification, are permitted provided that the following conditions
      9  1.2   itojun  * are met:
     10  1.2   itojun  * 1. Redistributions of source code must retain the above copyright
     11  1.2   itojun  *    notice, this list of conditions and the following disclaimer.
     12  1.2   itojun  * 2. Redistributions in binary form must reproduce the above copyright
     13  1.2   itojun  *    notice, this list of conditions and the following disclaimer in the
     14  1.2   itojun  *    documentation and/or other materials provided with the distribution.
     15  1.2   itojun  * 3. Neither the name of the project nor the names of its contributors
     16  1.2   itojun  *    may be used to endorse or promote products derived from this software
     17  1.2   itojun  *    without specific prior written permission.
     18  1.2   itojun  *
     19  1.2   itojun  * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
     20  1.2   itojun  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     21  1.2   itojun  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     22  1.2   itojun  * ARE DISCLAIMED.  IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
     23  1.2   itojun  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     24  1.2   itojun  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     25  1.2   itojun  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     26  1.2   itojun  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     27  1.2   itojun  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     28  1.2   itojun  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     29  1.2   itojun  * SUCH DAMAGE.
     30  1.2   itojun  */
     31  1.2   itojun 
     32  1.2   itojun /*
     33  1.2   itojun  * Copyright (c) 1982, 1986, 1988, 1993
     34  1.2   itojun  *	The Regents of the University of California.  All rights reserved.
     35  1.2   itojun  *
     36  1.2   itojun  * Redistribution and use in source and binary forms, with or without
     37  1.2   itojun  * modification, are permitted provided that the following conditions
     38  1.2   itojun  * are met:
     39  1.2   itojun  * 1. Redistributions of source code must retain the above copyright
     40  1.2   itojun  *    notice, this list of conditions and the following disclaimer.
     41  1.2   itojun  * 2. Redistributions in binary form must reproduce the above copyright
     42  1.2   itojun  *    notice, this list of conditions and the following disclaimer in the
     43  1.2   itojun  *    documentation and/or other materials provided with the distribution.
     44  1.2   itojun  * 3. All advertising materials mentioning features or use of this software
     45  1.2   itojun  *    must display the following acknowledgement:
     46  1.2   itojun  *	This product includes software developed by the University of
     47  1.2   itojun  *	California, Berkeley and its contributors.
     48  1.2   itojun  * 4. Neither the name of the University nor the names of its contributors
     49  1.2   itojun  *    may be used to endorse or promote products derived from this software
     50  1.2   itojun  *    without specific prior written permission.
     51  1.2   itojun  *
     52  1.2   itojun  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     53  1.2   itojun  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     54  1.2   itojun  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     55  1.2   itojun  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     56  1.2   itojun  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     57  1.2   itojun  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     58  1.2   itojun  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     59  1.2   itojun  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     60  1.2   itojun  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     61  1.2   itojun  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     62  1.2   itojun  * SUCH DAMAGE.
     63  1.2   itojun  *
     64  1.2   itojun  *	@(#)ip_icmp.c	8.2 (Berkeley) 1/4/94
     65  1.2   itojun  */
     66  1.2   itojun 
     67  1.2   itojun #if (defined(__FreeBSD__) && __FreeBSD__ >= 3) || defined(__NetBSD__)
     68  1.2   itojun #include "opt_inet.h"
     69  1.6  thorpej #include "opt_ipsec.h"
     70  1.2   itojun #endif
     71  1.2   itojun 
     72  1.2   itojun #include <sys/param.h>
     73  1.2   itojun #include <sys/systm.h>
     74  1.2   itojun #include <sys/malloc.h>
     75  1.2   itojun #include <sys/mbuf.h>
     76  1.2   itojun #include <sys/protosw.h>
     77  1.2   itojun #include <sys/socket.h>
     78  1.2   itojun #include <sys/socketvar.h>
     79  1.2   itojun #include <sys/time.h>
     80  1.2   itojun #include <sys/kernel.h>
     81  1.2   itojun #include <sys/syslog.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.2   itojun #include <netinet6/in6_systm.h>
     91  1.2   itojun #include <netinet6/ip6.h>
     92  1.2   itojun #include <netinet6/ip6_var.h>
     93  1.2   itojun #include <netinet6/icmp6.h>
     94  1.2   itojun #include <netinet6/mld6_var.h>
     95  1.2   itojun #if !defined(__FreeBSD__) || __FreeBSD__ < 3
     96  1.2   itojun #include <netinet6/in6_pcb.h>
     97  1.2   itojun #else
     98  1.2   itojun #include <netinet/in_pcb.h>
     99  1.2   itojun #endif
    100  1.2   itojun #include <netinet6/nd6.h>
    101  1.2   itojun #include <netinet6/in6_ifattach.h>
    102  1.2   itojun 
    103  1.2   itojun #ifdef IPSEC
    104  1.2   itojun #include <netkey/key.h>
    105  1.2   itojun #include <netkey/key_debug.h>
    106  1.2   itojun #endif
    107  1.2   itojun 
    108  1.2   itojun #include "faith.h"
    109  1.2   itojun 
    110  1.2   itojun extern struct protosw inet6sw[];
    111  1.2   itojun extern u_char ip6_protox[];
    112  1.2   itojun 
    113  1.2   itojun struct icmp6stat icmp6stat;
    114  1.2   itojun 
    115  1.2   itojun #if !defined(__FreeBSD__) || __FreeBSD__ < 3
    116  1.2   itojun extern struct in6pcb rawin6pcb;
    117  1.2   itojun #else
    118  1.2   itojun extern struct inpcbhead ripcb;
    119  1.2   itojun #endif
    120  1.2   itojun extern u_int icmp6errratelim;
    121  1.8   itojun #ifdef __NetBSD__
    122  1.8   itojun static struct rttimer_queue *icmp6_mtudisc_timeout_q = NULL;
    123  1.8   itojun extern int pmtu_expire;
    124  1.8   itojun #endif
    125  1.8   itojun 
    126  1.2   itojun static int icmp6_rip6_input __P((struct mbuf **, int));
    127  1.2   itojun static int icmp6_ratelimit __P((const struct in6_addr *, const int, const int));
    128  1.2   itojun static struct mbuf * ni6_input __P((struct mbuf *, int));
    129  1.2   itojun static int ni6_addrs __P((struct icmp6_nodeinfo *, struct mbuf *,
    130  1.2   itojun 			  struct ifnet **));
    131  1.2   itojun static int ni6_store_addrs __P((struct icmp6_nodeinfo *, struct icmp6_nodeinfo *,
    132  1.2   itojun 				struct ifnet *, int));
    133  1.8   itojun static struct rtentry *icmp6_mtudisc_clone __P((struct sockaddr *));
    134  1.8   itojun static void icmp6_mtudisc_timeout __P((struct rtentry *, struct rttimer *));
    135  1.2   itojun 
    136  1.2   itojun #ifdef COMPAT_RFC1885
    137  1.2   itojun static struct route_in6 icmp6_reflect_rt;
    138  1.2   itojun #endif
    139  1.2   itojun static struct timeval icmp6_nextsend = {0, 0};
    140  1.2   itojun 
    141  1.2   itojun void
    142  1.2   itojun icmp6_init()
    143  1.2   itojun {
    144  1.2   itojun 	mld6_init();
    145  1.8   itojun #ifdef __NetBSD__
    146  1.8   itojun 	icmp6_mtudisc_timeout_q = rt_timer_queue_create(pmtu_expire);
    147  1.8   itojun #endif
    148  1.2   itojun }
    149  1.2   itojun 
    150  1.2   itojun /*
    151  1.2   itojun  * Generate an error packet of type error in response to bad IP6 packet.
    152  1.2   itojun  */
    153  1.2   itojun void
    154  1.2   itojun icmp6_error(m, type, code, param)
    155  1.2   itojun 	struct mbuf *m;
    156  1.2   itojun 	int type, code, param;
    157  1.2   itojun {
    158  1.2   itojun 	struct ip6_hdr *oip6, *nip6;
    159  1.2   itojun 	struct icmp6_hdr *icmp6;
    160  1.2   itojun 	u_int prep;
    161  1.2   itojun 	int off;
    162  1.2   itojun 	u_char nxt;
    163  1.2   itojun 
    164  1.2   itojun 	icmp6stat.icp6s_error++;
    165  1.2   itojun 
    166  1.2   itojun 	if (m->m_flags & M_DECRYPTED)
    167  1.2   itojun 		goto freeit;
    168  1.2   itojun 
    169  1.2   itojun 	oip6 = mtod(m, struct ip6_hdr *);
    170  1.2   itojun 
    171  1.2   itojun 	/*
    172  1.2   itojun 	 * Multicast destination check. For unrecognized option errors,
    173  1.2   itojun 	 * this check has already done in ip6_unknown_opt(), so we can
    174  1.2   itojun 	 * check only for other errors.
    175  1.2   itojun 	 */
    176  1.2   itojun 	if ((m->m_flags & (M_BCAST|M_MCAST) ||
    177  1.2   itojun 	     IN6_IS_ADDR_MULTICAST(&oip6->ip6_dst)) &&
    178  1.2   itojun 	    (type != ICMP6_PACKET_TOO_BIG &&
    179  1.2   itojun 	     (type != ICMP6_PARAM_PROB ||
    180  1.2   itojun 	      code != ICMP6_PARAMPROB_OPTION)))
    181  1.2   itojun 		goto freeit;
    182  1.2   itojun 
    183  1.2   itojun 	/* Source address check. XXX: the case of anycast source? */
    184  1.2   itojun 	if (IN6_IS_ADDR_UNSPECIFIED(&oip6->ip6_src) ||
    185  1.2   itojun 	    IN6_IS_ADDR_MULTICAST(&oip6->ip6_src))
    186  1.2   itojun 		goto freeit;
    187  1.2   itojun 
    188  1.2   itojun 	/*
    189  1.2   itojun 	 * If the erroneous packet is also an ICMP error, discard it.
    190  1.2   itojun 	 */
    191  1.2   itojun 	IP6_EXTHDR_CHECK(m, 0, sizeof(struct ip6_hdr), );
    192  1.2   itojun 	off = sizeof(struct ip6_hdr);
    193  1.2   itojun 	nxt = oip6->ip6_nxt;
    194  1.2   itojun 	while(1) {		/* XXX: should avoid inf. loop explicitly? */
    195  1.2   itojun 		struct ip6_ext *ip6e;
    196  1.2   itojun 		struct icmp6_hdr *icp;
    197  1.2   itojun 
    198  1.2   itojun 		switch(nxt) {
    199  1.2   itojun 		case IPPROTO_IPV6:
    200  1.2   itojun 		case IPPROTO_IPV4:
    201  1.2   itojun 		case IPPROTO_UDP:
    202  1.2   itojun 		case IPPROTO_TCP:
    203  1.2   itojun 		case IPPROTO_ESP:
    204  1.2   itojun 		case IPPROTO_FRAGMENT:
    205  1.2   itojun 			/*
    206  1.2   itojun 			 * ICMPv6 error must not be fragmented.
    207  1.2   itojun 			 * XXX: but can we trust the sender?
    208  1.2   itojun 			 */
    209  1.2   itojun 		default:
    210  1.2   itojun 			/* What if unknown header followed by ICMP error? */
    211  1.2   itojun 			goto generate;
    212  1.2   itojun 		case IPPROTO_ICMPV6:
    213  1.2   itojun 			IP6_EXTHDR_CHECK(m, 0, off + sizeof(struct icmp6_hdr), );
    214  1.2   itojun 			icp = (struct icmp6_hdr *)(mtod(m, caddr_t) + off);
    215  1.2   itojun 			if (icp->icmp6_type < ICMP6_ECHO_REQUEST
    216  1.2   itojun 			 || icp->icmp6_type == ND_REDIRECT) {
    217  1.2   itojun 				/*
    218  1.2   itojun 				 * ICMPv6 error
    219  1.2   itojun 				 * Special case: for redirect (which is
    220  1.2   itojun 				 * informational) we must not send icmp6 error.
    221  1.2   itojun 				 */
    222  1.2   itojun 				icmp6stat.icp6s_canterror++;
    223  1.2   itojun 				goto freeit;
    224  1.2   itojun 			} else {
    225  1.2   itojun 				/* ICMPv6 informational */
    226  1.2   itojun 				goto generate;
    227  1.2   itojun 			}
    228  1.2   itojun 		case IPPROTO_HOPOPTS:
    229  1.2   itojun 		case IPPROTO_DSTOPTS:
    230  1.2   itojun 		case IPPROTO_ROUTING:
    231  1.2   itojun 		case IPPROTO_AH:
    232  1.2   itojun 			IP6_EXTHDR_CHECK(m, 0, off + sizeof(struct ip6_ext), );
    233  1.2   itojun 			ip6e = (struct ip6_ext *)(mtod(m, caddr_t) + off);
    234  1.2   itojun 			if (nxt == IPPROTO_AH)
    235  1.2   itojun 				off += (ip6e->ip6e_len + 2) << 2;
    236  1.2   itojun 			else
    237  1.2   itojun 				off += (ip6e->ip6e_len + 1) << 3;
    238  1.2   itojun 			nxt = ip6e->ip6e_nxt;
    239  1.2   itojun 			break;
    240  1.2   itojun 		}
    241  1.2   itojun 	}
    242  1.2   itojun 
    243  1.2   itojun   freeit:
    244  1.2   itojun 	/*
    245  1.2   itojun 	 * If we can't tell wheter or not we can generate ICMP6, free it.
    246  1.2   itojun 	 */
    247  1.2   itojun 	m_freem(m);
    248  1.2   itojun 	return;
    249  1.2   itojun 
    250  1.2   itojun   generate:
    251  1.2   itojun 	oip6 = mtod(m, struct ip6_hdr *); /* adjust pointer */
    252  1.2   itojun 
    253  1.2   itojun 	/* Finally, do rate limitation check. */
    254  1.2   itojun 	if (icmp6_ratelimit(&oip6->ip6_src, type, code)) {
    255  1.2   itojun 		icmp6stat.icp6s_toofreq++;
    256  1.2   itojun 		goto freeit;
    257  1.2   itojun 	}
    258  1.2   itojun 
    259  1.2   itojun 	/*
    260  1.2   itojun 	 * OK, ICMP6 can be generated.
    261  1.2   itojun 	 */
    262  1.2   itojun 
    263  1.2   itojun 	if (m->m_pkthdr.len >= ICMPV6_PLD_MAXLEN)
    264  1.2   itojun 		m_adj(m, ICMPV6_PLD_MAXLEN - m->m_pkthdr.len);
    265  1.2   itojun 
    266  1.2   itojun 	prep = sizeof(struct ip6_hdr) + sizeof(struct icmp6_hdr);
    267  1.2   itojun 	M_PREPEND(m, prep, M_DONTWAIT);
    268  1.2   itojun 	if (m && m->m_len < prep)
    269  1.2   itojun 		m = m_pullup(m, prep);
    270  1.2   itojun 	if (m == NULL) {
    271  1.2   itojun 		printf("ENOBUFS in icmp6_error %d\n", __LINE__);
    272  1.2   itojun 		return;
    273  1.2   itojun 	}
    274  1.2   itojun 
    275  1.2   itojun 	nip6 = mtod(m, struct ip6_hdr *);
    276  1.2   itojun 	nip6->ip6_src  = oip6->ip6_src;
    277  1.2   itojun 	nip6->ip6_dst  = oip6->ip6_dst;
    278  1.2   itojun 
    279  1.2   itojun 	if (IN6_IS_SCOPE_LINKLOCAL(&oip6->ip6_src))
    280  1.2   itojun 		oip6->ip6_src.s6_addr16[1] = 0;
    281  1.2   itojun 	if (IN6_IS_SCOPE_LINKLOCAL(&oip6->ip6_dst))
    282  1.2   itojun 		oip6->ip6_dst.s6_addr16[1] = 0;
    283  1.2   itojun 
    284  1.2   itojun 	icmp6 = (struct icmp6_hdr *)(nip6 + 1);
    285  1.2   itojun 	icmp6->icmp6_type = type;
    286  1.2   itojun 	icmp6->icmp6_code = code;
    287  1.7   itojun 	icmp6->icmp6_pptr = htonl((u_int32_t)param);
    288  1.2   itojun 
    289  1.2   itojun 	icmp6stat.icp6s_outhist[type]++;
    290  1.2   itojun 	icmp6_reflect(m, sizeof(struct ip6_hdr)); /*header order: IPv6 - ICMPv6*/
    291  1.2   itojun }
    292  1.2   itojun 
    293  1.2   itojun /*
    294  1.2   itojun  * Process a received ICMP6 message.
    295  1.2   itojun  */
    296  1.2   itojun int
    297  1.2   itojun icmp6_input(mp, offp, proto)
    298  1.2   itojun 	struct mbuf **mp;
    299  1.2   itojun 	int *offp, proto;
    300  1.2   itojun {
    301  1.2   itojun 	struct mbuf *m = *mp, *n;
    302  1.2   itojun 	struct ip6_hdr *ip6, *nip6;
    303  1.2   itojun 	struct icmp6_hdr *icmp6, *nicmp6;
    304  1.2   itojun 	int off = *offp;
    305  1.2   itojun 	int icmp6len = m->m_pkthdr.len - *offp;
    306  1.2   itojun 	int code, sum, noff;
    307  1.2   itojun 	struct sockaddr_in6 icmp6src;
    308  1.2   itojun 
    309  1.2   itojun 	IP6_EXTHDR_CHECK(m, off, sizeof(struct icmp6_hdr), IPPROTO_DONE);
    310  1.2   itojun 	/* m might change if M_LOOP. So, call mtod after this */
    311  1.2   itojun 
    312  1.2   itojun 	/*
    313  1.2   itojun 	 * Locate icmp6 structure in mbuf, and check
    314  1.2   itojun 	 * that not corrupted and of at least minimum length
    315  1.2   itojun 	 */
    316  1.2   itojun 
    317  1.2   itojun 	ip6 = mtod(m, struct ip6_hdr *);
    318  1.2   itojun 	if (icmp6len < sizeof(struct icmp6_hdr)) {
    319  1.2   itojun 		icmp6stat.icp6s_tooshort++;
    320  1.2   itojun 		goto freeit;
    321  1.2   itojun 	}
    322  1.2   itojun 
    323  1.2   itojun 	/*
    324  1.2   itojun 	 * calculate the checksum
    325  1.2   itojun 	 */
    326  1.2   itojun 
    327  1.2   itojun 	icmp6 = (struct icmp6_hdr *)((caddr_t)ip6 + off);
    328  1.2   itojun 	code = icmp6->icmp6_code;
    329  1.2   itojun 
    330  1.2   itojun 	if ((sum = in6_cksum(m, IPPROTO_ICMPV6, off, icmp6len)) != 0) {
    331  1.2   itojun 		log(LOG_ERR,
    332  1.2   itojun 		    "ICMP6 checksum error(%d|%x) %s\n",
    333  1.2   itojun 		    icmp6->icmp6_type,
    334  1.2   itojun 		    sum,
    335  1.2   itojun 		    ip6_sprintf(&ip6->ip6_src));
    336  1.2   itojun 		icmp6stat.icp6s_checksum++;
    337  1.2   itojun 		goto freeit;
    338  1.2   itojun 	}
    339  1.2   itojun 
    340  1.2   itojun #if defined(NFAITH) && 0 < NFAITH
    341  1.2   itojun 	if (m->m_pkthdr.rcvif && m->m_pkthdr.rcvif->if_type == IFT_FAITH) {
    342  1.2   itojun 		/*
    343  1.2   itojun 		 * Deliver very specific ICMP6 type only.
    344  1.2   itojun 		 * This is important to deilver TOOBIG.  Otherwise PMTUD
    345  1.2   itojun 		 * will not work.
    346  1.2   itojun 		 */
    347  1.2   itojun 		switch (icmp6->icmp6_type) {
    348  1.2   itojun 		case ICMP6_DST_UNREACH:
    349  1.2   itojun 		case ICMP6_PACKET_TOO_BIG:
    350  1.2   itojun 		case ICMP6_TIME_EXCEEDED:
    351  1.2   itojun 			break;
    352  1.2   itojun 		default:
    353  1.2   itojun 			goto freeit;
    354  1.2   itojun 		}
    355  1.2   itojun 	}
    356  1.2   itojun #endif
    357  1.2   itojun 
    358  1.2   itojun #ifdef IPSEC
    359  1.5   itojun 	/* drop it if it does not match the default policy */
    360  1.2   itojun 	if (ipsec6_in_reject(m, NULL)) {
    361  1.2   itojun 		ipsecstat.in_polvio++;
    362  1.2   itojun 		goto freeit;
    363  1.2   itojun 	}
    364  1.2   itojun #endif
    365  1.2   itojun 
    366  1.2   itojun 	icmp6stat.icp6s_inhist[icmp6->icmp6_type]++;
    367  1.2   itojun 
    368  1.2   itojun 	switch (icmp6->icmp6_type) {
    369  1.2   itojun 
    370  1.2   itojun 	case ICMP6_DST_UNREACH:
    371  1.2   itojun 		switch (code) {
    372  1.2   itojun 		case ICMP6_DST_UNREACH_NOROUTE:
    373  1.2   itojun 			code = PRC_UNREACH_NET;
    374  1.2   itojun 			break;
    375  1.2   itojun 		case ICMP6_DST_UNREACH_ADMIN:
    376  1.2   itojun 		case ICMP6_DST_UNREACH_ADDR:
    377  1.2   itojun 			code = PRC_UNREACH_HOST;
    378  1.2   itojun 			break;
    379  1.2   itojun 		case ICMP6_DST_UNREACH_NOTNEIGHBOR:
    380  1.2   itojun 			code = PRC_UNREACH_SRCFAIL;
    381  1.2   itojun 			break;
    382  1.2   itojun 		case ICMP6_DST_UNREACH_NOPORT:
    383  1.2   itojun 			code = PRC_UNREACH_PORT;
    384  1.2   itojun 			break;
    385  1.2   itojun 		default:
    386  1.2   itojun 			goto badcode;
    387  1.2   itojun 		}
    388  1.2   itojun 		goto deliver;
    389  1.2   itojun 		break;
    390  1.2   itojun 
    391  1.2   itojun 	case ICMP6_PACKET_TOO_BIG:
    392  1.2   itojun 		if (code != 0)
    393  1.2   itojun 			goto badcode;
    394  1.2   itojun 	    {
    395  1.2   itojun 		u_int mtu = ntohl(icmp6->icmp6_mtu);
    396  1.2   itojun 		struct rtentry *rt;
    397  1.2   itojun 		struct sockaddr_in6 sin6;
    398  1.2   itojun #ifdef __bsdi__
    399  1.2   itojun 		struct route_in6 ro6;
    400  1.2   itojun #endif
    401  1.2   itojun 
    402  1.2   itojun 		code = PRC_MSGSIZE;
    403  1.2   itojun 		bzero(&sin6, sizeof(sin6));
    404  1.2   itojun 		sin6.sin6_family = PF_INET6;
    405  1.2   itojun 		sin6.sin6_len = sizeof(struct sockaddr_in6);
    406  1.2   itojun 		sin6.sin6_addr = ((struct ip6_hdr *)(icmp6 + 1))->ip6_dst;
    407  1.8   itojun #ifdef __NetBSD__
    408  1.8   itojun 		rt = rtalloc1((struct sockaddr *)&sin6, 1);	/*clone*/
    409  1.8   itojun 		if (!rt || (rt->rt_flags & RTF_HOST) == 0) {
    410  1.8   itojun 			if (rt)
    411  1.8   itojun 				RTFREE(rt);
    412  1.8   itojun 			rt = icmp6_mtudisc_clone((struct sockaddr *)&sin6);
    413  1.8   itojun 		}
    414  1.8   itojun #endif
    415  1.2   itojun #ifdef __FreeBSD__
    416  1.8   itojun 		rt = rtalloc1((struct sockaddr *)&sin6, 0,
    417  1.8   itojun 			RTF_CLONING | RTF_PRCLONING);
    418  1.2   itojun #endif /*__FreeBSD__*/
    419  1.2   itojun #ifdef __bsdi__
    420  1.2   itojun 		bcopy(&sin6, &ro6.ro_dst, sizeof(struct sockaddr_in6));
    421  1.2   itojun 		ro6.ro_rt = 0;
    422  1.2   itojun 		rtcalloc((struct route *)&ro6);
    423  1.2   itojun 		rt = ro6.ro_rt;
    424  1.2   itojun #endif /*__bsdi__*/
    425  1.8   itojun 
    426  1.2   itojun 		if (rt && (rt->rt_flags & RTF_HOST)
    427  1.2   itojun 		    && !(rt->rt_rmx.rmx_locks & RTV_MTU)) {
    428  1.2   itojun 			if (mtu < IPV6_MMTU) {
    429  1.2   itojun 				/* xxx */
    430  1.2   itojun 				rt->rt_rmx.rmx_locks |= RTV_MTU;
    431  1.2   itojun 			} else if (mtu < rt->rt_ifp->if_mtu &&
    432  1.2   itojun 				   rt->rt_rmx.rmx_mtu > mtu) {
    433  1.2   itojun 				rt->rt_rmx.rmx_mtu = mtu;
    434  1.2   itojun 			}
    435  1.2   itojun 		}
    436  1.2   itojun 		if (rt)
    437  1.2   itojun 			RTFREE(rt);
    438  1.2   itojun 
    439  1.2   itojun 		goto deliver;
    440  1.2   itojun 	    }
    441  1.2   itojun 		break;
    442  1.2   itojun 
    443  1.2   itojun 	case ICMP6_TIME_EXCEEDED:
    444  1.2   itojun 		switch (code) {
    445  1.2   itojun 		case ICMP6_TIME_EXCEED_TRANSIT:
    446  1.2   itojun 		case ICMP6_TIME_EXCEED_REASSEMBLY:
    447  1.2   itojun 			code += PRC_TIMXCEED_INTRANS;
    448  1.2   itojun 			break;
    449  1.2   itojun 		default:
    450  1.2   itojun 			goto badcode;
    451  1.2   itojun 		}
    452  1.2   itojun 		goto deliver;
    453  1.2   itojun 		break;
    454  1.2   itojun 
    455  1.2   itojun 	case ICMP6_PARAM_PROB:
    456  1.2   itojun 		switch (code) {
    457  1.2   itojun 		case ICMP6_PARAMPROB_NEXTHEADER:
    458  1.2   itojun 			code = PRC_UNREACH_PROTOCOL;
    459  1.2   itojun 			break;
    460  1.2   itojun 		case ICMP6_PARAMPROB_HEADER:
    461  1.2   itojun 		case ICMP6_PARAMPROB_OPTION:
    462  1.2   itojun 			code = PRC_PARAMPROB;
    463  1.2   itojun 			break;
    464  1.2   itojun 		default:
    465  1.2   itojun 			goto badcode;
    466  1.2   itojun 		}
    467  1.2   itojun 		goto deliver;
    468  1.2   itojun 		break;
    469  1.2   itojun 
    470  1.2   itojun 	case ICMP6_ECHO_REQUEST:
    471  1.2   itojun 		if (code != 0)
    472  1.2   itojun 			goto badcode;
    473  1.2   itojun 		if ((n = m_copy(m, 0, M_COPYALL)) == NULL) {
    474  1.2   itojun 			/* Give up remote */
    475  1.2   itojun 			break;
    476  1.2   itojun 		}
    477  1.2   itojun 		if (n->m_flags & M_EXT) {
    478  1.2   itojun 			int gap, move;
    479  1.2   itojun 			struct mbuf *n0 = n;
    480  1.2   itojun 
    481  1.2   itojun 			/*
    482  1.2   itojun 			 * Prepare an internal mbuf. m_pullup() doesn't
    483  1.2   itojun 			 * always copy the length we specified.
    484  1.2   itojun 			 */
    485  1.2   itojun 			MGETHDR(n, M_DONTWAIT, n0->m_type);
    486  1.2   itojun 			if (n == NULL) {
    487  1.2   itojun 				/* Give up remote */
    488  1.2   itojun 				m_freem(n0);
    489  1.2   itojun 				break;
    490  1.2   itojun 			}
    491  1.2   itojun 			M_COPY_PKTHDR(n, n0);
    492  1.2   itojun 			n0->m_flags &= ~M_PKTHDR;
    493  1.2   itojun 			n->m_next = n0;
    494  1.2   itojun 			/*
    495  1.2   itojun 			 * Copy IPv6 and ICMPv6 only.
    496  1.2   itojun 			 */
    497  1.2   itojun 			nip6 = mtod(n, struct ip6_hdr *);
    498  1.2   itojun 			bcopy(ip6, nip6, sizeof(struct ip6_hdr));
    499  1.2   itojun 			nicmp6 = (struct icmp6_hdr *)(nip6 + 1);
    500  1.2   itojun 			bcopy(icmp6, nicmp6, sizeof(struct icmp6_hdr));
    501  1.2   itojun 			/*
    502  1.2   itojun 			 * Adjust mbuf. ip6_plen will be adjusted.
    503  1.2   itojun 			 */
    504  1.2   itojun 			noff = sizeof(struct ip6_hdr);
    505  1.2   itojun 			n->m_len = noff + sizeof(struct icmp6_hdr);
    506  1.2   itojun 			move = off + sizeof(struct icmp6_hdr);
    507  1.2   itojun 			n0->m_len -= move;
    508  1.2   itojun 			n0->m_data += move;
    509  1.2   itojun 			gap = off - noff;
    510  1.2   itojun 			n->m_pkthdr.len -= gap;
    511  1.2   itojun 		} else {
    512  1.2   itojun 			nip6 = mtod(n, struct ip6_hdr *);
    513  1.2   itojun 			nicmp6 = (struct icmp6_hdr *)((caddr_t)nip6 + off);
    514  1.2   itojun 			noff = off;
    515  1.2   itojun 		}
    516  1.2   itojun 		nicmp6->icmp6_type = ICMP6_ECHO_REPLY;
    517  1.2   itojun 		nicmp6->icmp6_code = 0;
    518  1.2   itojun 		icmp6stat.icp6s_reflect++;
    519  1.2   itojun 		icmp6stat.icp6s_outhist[ICMP6_ECHO_REPLY]++;
    520  1.2   itojun 		icmp6_reflect(n, noff);
    521  1.2   itojun 		break;
    522  1.2   itojun 
    523  1.2   itojun 	case ICMP6_ECHO_REPLY:
    524  1.2   itojun 		if (code != 0)
    525  1.2   itojun 			goto badcode;
    526  1.2   itojun 		break;
    527  1.2   itojun 
    528  1.2   itojun 	case MLD6_LISTENER_QUERY:
    529  1.2   itojun 	case MLD6_LISTENER_REPORT:
    530  1.2   itojun 		if (icmp6len < sizeof(struct mld6_hdr))
    531  1.2   itojun 			goto badlen;
    532  1.2   itojun 		IP6_EXTHDR_CHECK(m, off, icmp6len, IPPROTO_DONE);
    533  1.2   itojun 		mld6_input(m, off);
    534  1.2   itojun 		/* m stays. */
    535  1.2   itojun 		break;
    536  1.2   itojun 
    537  1.2   itojun 	case MLD6_LISTENER_DONE:
    538  1.2   itojun 		if (icmp6len < sizeof(struct mld6_hdr))
    539  1.2   itojun 			goto badlen;
    540  1.2   itojun 		break;		/* nothing to be done in kernel */
    541  1.2   itojun 
    542  1.2   itojun 	case ICMP6_WRUREQUEST:	/* ICMP6_FQDN_QUERY */
    543  1.2   itojun 	    {
    544  1.2   itojun 		enum { WRU, FQDN } mode;
    545  1.2   itojun 
    546  1.2   itojun 		if (code != 0)
    547  1.2   itojun 			goto badcode;
    548  1.2   itojun 		if (icmp6len == sizeof(struct icmp6_hdr) + 4)
    549  1.2   itojun 			mode = WRU;
    550  1.2   itojun 		else if (icmp6len >= sizeof(struct icmp6_hdr) + 8) /* XXX */
    551  1.2   itojun 			mode = FQDN;
    552  1.2   itojun 		else
    553  1.2   itojun 			goto badlen;
    554  1.2   itojun 
    555  1.2   itojun #ifdef __FreeBSD__
    556  1.2   itojun #define hostnamelen	strlen(hostname)
    557  1.2   itojun #endif
    558  1.2   itojun 		if (mode == FQDN) {
    559  1.2   itojun 			IP6_EXTHDR_CHECK(m, off, sizeof(struct icmp6_nodeinfo),
    560  1.2   itojun 					 IPPROTO_DONE);
    561  1.2   itojun 			n = ni6_input(m, off);
    562  1.2   itojun 			noff = sizeof(struct ip6_hdr);
    563  1.2   itojun 		}
    564  1.2   itojun 		else {
    565  1.2   itojun 			u_char *p;
    566  1.2   itojun 
    567  1.2   itojun 			MGETHDR(n, M_DONTWAIT, m->m_type);
    568  1.2   itojun 			if (n == NULL) {
    569  1.2   itojun 				/* Give up remote */
    570  1.2   itojun 				break;
    571  1.2   itojun 			}
    572  1.2   itojun 			/*
    573  1.2   itojun 			 * Copy IPv6 and ICMPv6 only.
    574  1.2   itojun 			 */
    575  1.2   itojun 			nip6 = mtod(n, struct ip6_hdr *);
    576  1.2   itojun 			bcopy(ip6, nip6, sizeof(struct ip6_hdr));
    577  1.2   itojun 			nicmp6 = (struct icmp6_hdr *)(nip6 + 1);
    578  1.2   itojun 			bcopy(icmp6, nicmp6, sizeof(struct icmp6_hdr));
    579  1.2   itojun 			p = (u_char *)(nicmp6 + 1);
    580  1.2   itojun 			bzero(p, 4);
    581  1.2   itojun 			bcopy(hostname, p + 4, hostnamelen);
    582  1.2   itojun 			noff = sizeof(struct ip6_hdr);
    583  1.2   itojun 			M_COPY_PKTHDR(n, m); /* just for recvif */
    584  1.2   itojun 			n->m_pkthdr.len = n->m_len = sizeof(struct ip6_hdr) +
    585  1.2   itojun 				sizeof(struct icmp6_hdr) + 4 + hostnamelen;
    586  1.2   itojun 			nicmp6->icmp6_type = ICMP6_WRUREPLY;
    587  1.2   itojun 			nicmp6->icmp6_code = 0;
    588  1.2   itojun 		}
    589  1.2   itojun #undef hostnamelen
    590  1.2   itojun 		if (n) {
    591  1.2   itojun 			icmp6stat.icp6s_reflect++;
    592  1.2   itojun 			icmp6stat.icp6s_outhist[ICMP6_WRUREPLY]++;
    593  1.2   itojun 			icmp6_reflect(n, noff);
    594  1.2   itojun 		}
    595  1.2   itojun 		break;
    596  1.2   itojun 	    }
    597  1.2   itojun 
    598  1.2   itojun 	case ICMP6_WRUREPLY:
    599  1.2   itojun 		if (code != 0)
    600  1.2   itojun 			goto badcode;
    601  1.2   itojun 		break;
    602  1.2   itojun 
    603  1.2   itojun 	case ND_ROUTER_SOLICIT:
    604  1.2   itojun 		if (code != 0)
    605  1.2   itojun 			goto badcode;
    606  1.2   itojun 		if (icmp6len < sizeof(struct nd_router_solicit))
    607  1.2   itojun 			goto badlen;
    608  1.2   itojun 		IP6_EXTHDR_CHECK(m, off, icmp6len, IPPROTO_DONE);
    609  1.2   itojun 		nd6_rs_input(m, off, icmp6len);
    610  1.2   itojun 		/* m stays. */
    611  1.2   itojun 		break;
    612  1.2   itojun 
    613  1.2   itojun 	case ND_ROUTER_ADVERT:
    614  1.2   itojun 		if (code != 0)
    615  1.2   itojun 			goto badcode;
    616  1.2   itojun 		if (icmp6len < sizeof(struct nd_router_advert))
    617  1.2   itojun 			goto badlen;
    618  1.2   itojun 		IP6_EXTHDR_CHECK(m, off, icmp6len, IPPROTO_DONE);
    619  1.2   itojun 		nd6_ra_input(m, off, icmp6len);
    620  1.2   itojun 		/* m stays. */
    621  1.2   itojun 		break;
    622  1.2   itojun 
    623  1.2   itojun 	case ND_NEIGHBOR_SOLICIT:
    624  1.2   itojun 		if (code != 0)
    625  1.2   itojun 			goto badcode;
    626  1.2   itojun 		if (icmp6len < sizeof(struct nd_neighbor_solicit))
    627  1.2   itojun 			goto badlen;
    628  1.2   itojun 		IP6_EXTHDR_CHECK(m, off, icmp6len, IPPROTO_DONE);
    629  1.2   itojun 		nd6_ns_input(m, off, icmp6len);
    630  1.2   itojun 		/* m stays. */
    631  1.2   itojun 		break;
    632  1.2   itojun 
    633  1.2   itojun 	case ND_NEIGHBOR_ADVERT:
    634  1.2   itojun 		if (code != 0)
    635  1.2   itojun 			goto badcode;
    636  1.2   itojun 		if (icmp6len < sizeof(struct nd_neighbor_advert))
    637  1.2   itojun 			goto badlen;
    638  1.2   itojun 		IP6_EXTHDR_CHECK(m, off, icmp6len, IPPROTO_DONE);
    639  1.2   itojun 		nd6_na_input(m, off, icmp6len);
    640  1.2   itojun 		/* m stays. */
    641  1.2   itojun 		break;
    642  1.2   itojun 
    643  1.2   itojun 	case ND_REDIRECT:
    644  1.2   itojun 		if (code != 0)
    645  1.2   itojun 			goto badcode;
    646  1.2   itojun 		if (icmp6len < sizeof(struct nd_redirect))
    647  1.2   itojun 			goto badlen;
    648  1.2   itojun 		icmp6_redirect_input(m, off);
    649  1.2   itojun 		/* m stays. */
    650  1.2   itojun 		break;
    651  1.2   itojun 
    652  1.2   itojun 	case ICMP6_ROUTER_RENUMBERING:
    653  1.2   itojun 		if (code != ICMP6_ROUTER_RENUMBERING_COMMAND &&
    654  1.2   itojun 		    code != ICMP6_ROUTER_RENUMBERING_RESULT)
    655  1.2   itojun 			goto badcode;
    656  1.2   itojun 		if (icmp6len < sizeof(struct icmp6_router_renum))
    657  1.2   itojun 			goto badlen;
    658  1.2   itojun 		break;
    659  1.2   itojun 
    660  1.2   itojun 	default:
    661  1.2   itojun 		printf("icmp6_input: unknown type %d\n", icmp6->icmp6_type);
    662  1.2   itojun 		if (icmp6->icmp6_type < ICMP6_ECHO_REQUEST) {
    663  1.2   itojun 			/* ICMPv6 error: MUST deliver it by spec... */
    664  1.2   itojun 			code = PRC_NCMDS;
    665  1.2   itojun 			/* deliver */
    666  1.2   itojun 		} else {
    667  1.2   itojun 			/* ICMPv6 informational: MUST not deliver */
    668  1.2   itojun 			break;
    669  1.2   itojun 		}
    670  1.2   itojun 	deliver:
    671  1.2   itojun 		if (icmp6len < sizeof(struct icmp6_hdr) + sizeof(struct ip6_hdr)) {
    672  1.2   itojun 			icmp6stat.icp6s_tooshort++;
    673  1.2   itojun 			goto freeit;
    674  1.2   itojun 		}
    675  1.2   itojun 		IP6_EXTHDR_CHECK(m, off,
    676  1.2   itojun 			sizeof(struct icmp6_hdr) + sizeof(struct ip6_hdr),
    677  1.2   itojun 			IPPROTO_DONE);
    678  1.2   itojun 		icmp6 = (struct icmp6_hdr *)(mtod(m, caddr_t) + off);
    679  1.2   itojun 		bzero(&icmp6src, sizeof(icmp6src));
    680  1.2   itojun 		icmp6src.sin6_len = sizeof(struct sockaddr_in6);
    681  1.2   itojun 		icmp6src.sin6_family = AF_INET6;
    682  1.2   itojun 		icmp6src.sin6_addr = ((struct ip6_hdr *)(icmp6 + 1))->ip6_dst;
    683  1.2   itojun 
    684  1.2   itojun 		/* Detect the upper level protocol */
    685  1.2   itojun 	    {
    686  1.2   itojun 		void (*ctlfunc) __P((int, struct sockaddr *,
    687  1.2   itojun 				     struct ip6_hdr *,
    688  1.2   itojun 				     struct mbuf *, int)); /* XXX */
    689  1.2   itojun 		struct ip6_hdr *eip6 = (struct ip6_hdr *)(icmp6 + 1);
    690  1.2   itojun 		u_int8_t nxt = eip6->ip6_nxt;
    691  1.2   itojun 		int eoff = off + sizeof(struct icmp6_hdr) +
    692  1.2   itojun 			sizeof(struct ip6_hdr);
    693  1.2   itojun 
    694  1.2   itojun 		while (1) { /* XXX: should avoid inf. loop explicitly? */
    695  1.2   itojun 			struct ip6_ext *eh;
    696  1.2   itojun 
    697  1.2   itojun 			switch(nxt) {
    698  1.2   itojun 			case IPPROTO_ESP:
    699  1.2   itojun 			case IPPROTO_NONE:
    700  1.2   itojun 				goto passit;
    701  1.2   itojun 			case IPPROTO_HOPOPTS:
    702  1.2   itojun 			case IPPROTO_DSTOPTS:
    703  1.2   itojun 			case IPPROTO_ROUTING:
    704  1.2   itojun 			case IPPROTO_AH:
    705  1.2   itojun 			case IPPROTO_FRAGMENT:
    706  1.2   itojun 				IP6_EXTHDR_CHECK(m, 0, eoff +
    707  1.2   itojun 						 sizeof(struct ip6_ext),
    708  1.2   itojun 						 IPPROTO_DONE);
    709  1.2   itojun 				eh = (struct ip6_ext *)(mtod(m, caddr_t)
    710  1.2   itojun 							+ eoff);
    711  1.2   itojun 				if (nxt == IPPROTO_AH)
    712  1.2   itojun 					eoff += (eh->ip6e_len + 2) << 2;
    713  1.2   itojun 				else if (nxt == IPPROTO_FRAGMENT)
    714  1.2   itojun 					eoff += sizeof(struct ip6_frag);
    715  1.2   itojun 				else
    716  1.2   itojun 					eoff += (eh->ip6e_len + 1) << 3;
    717  1.2   itojun 				nxt = eh->ip6e_nxt;
    718  1.2   itojun 				break;
    719  1.2   itojun 			default:
    720  1.2   itojun 				goto notify;
    721  1.2   itojun 			}
    722  1.2   itojun 		}
    723  1.2   itojun 	    notify:
    724  1.2   itojun 		icmp6 = (struct icmp6_hdr *)(mtod(m, caddr_t) + off);
    725  1.2   itojun 		ctlfunc = (void (*) __P((int, struct sockaddr *,
    726  1.2   itojun 					 struct ip6_hdr *,
    727  1.2   itojun 					 struct mbuf *, int)))
    728  1.2   itojun 			(inet6sw[ip6_protox[nxt]].pr_ctlinput);
    729  1.2   itojun 		if (ctlfunc)
    730  1.2   itojun 			(*ctlfunc)(code, (struct sockaddr *)&icmp6src,
    731  1.2   itojun 				   (struct ip6_hdr *)(icmp6 + 1),
    732  1.2   itojun 				   m, eoff);
    733  1.2   itojun 	    }
    734  1.2   itojun 		break;
    735  1.2   itojun 
    736  1.2   itojun 	badcode:
    737  1.2   itojun 		icmp6stat.icp6s_badcode++;
    738  1.2   itojun 		break;
    739  1.2   itojun 
    740  1.2   itojun 	badlen:
    741  1.2   itojun 		icmp6stat.icp6s_badlen++;
    742  1.2   itojun 		break;
    743  1.2   itojun 	}
    744  1.2   itojun 
    745  1.2   itojun  passit:
    746  1.2   itojun 	icmp6_rip6_input(&m, *offp);
    747  1.2   itojun 	return IPPROTO_DONE;
    748  1.2   itojun 
    749  1.2   itojun  freeit:
    750  1.2   itojun 	m_freem(m);
    751  1.2   itojun 	return IPPROTO_DONE;
    752  1.2   itojun }
    753  1.2   itojun 
    754  1.2   itojun /*
    755  1.2   itojun  * Process a Node Information Query
    756  1.2   itojun  */
    757  1.2   itojun #ifdef __FreeBSD__
    758  1.2   itojun #define hostnamelen	strlen(hostname)
    759  1.2   itojun #endif
    760  1.2   itojun #ifndef offsetof		/* XXX */
    761  1.2   itojun #define	offsetof(type, member)	((size_t)(&((type *)0)->member))
    762  1.2   itojun #endif
    763  1.2   itojun 
    764  1.2   itojun static struct mbuf *
    765  1.2   itojun ni6_input(m, off)
    766  1.2   itojun 	struct mbuf *m;
    767  1.2   itojun 	int off;
    768  1.2   itojun {
    769  1.2   itojun 	struct icmp6_nodeinfo *ni6 =
    770  1.2   itojun 		(struct icmp6_nodeinfo *)(mtod(m, caddr_t) + off), *nni6;
    771  1.2   itojun 	struct mbuf *n = NULL;
    772  1.2   itojun 	u_int16_t qtype = ntohs(ni6->ni_qtype);
    773  1.2   itojun 	int replylen = sizeof(struct ip6_hdr) + sizeof(struct icmp6_nodeinfo);
    774  1.2   itojun 	struct ni_reply_fqdn *fqdn;
    775  1.2   itojun 	int addrs;		/* for NI_QTYPE_NODEADDR */
    776  1.2   itojun 	struct ifnet *ifp = NULL; /* for NI_QTYPE_NODEADDR */
    777  1.2   itojun 
    778  1.2   itojun 	switch(qtype) {
    779  1.2   itojun 	 case NI_QTYPE_NOOP:
    780  1.2   itojun 		 break;		/* no reply data */
    781  1.2   itojun 	 case NI_QTYPE_SUPTYPES:
    782  1.2   itojun 		 goto bad;	/* xxx: to be implemented */
    783  1.2   itojun 		 break;
    784  1.2   itojun 	 case NI_QTYPE_FQDN:
    785  1.2   itojun 		 replylen += offsetof(struct ni_reply_fqdn, ni_fqdn_name) +
    786  1.2   itojun 			 hostnamelen;
    787  1.2   itojun 		 break;
    788  1.2   itojun 	 case NI_QTYPE_NODEADDR:
    789  1.2   itojun 		 addrs = ni6_addrs(ni6, m, &ifp);
    790  1.2   itojun 		 if ((replylen += addrs * sizeof(struct in6_addr)) > MCLBYTES)
    791  1.2   itojun 			 replylen = MCLBYTES; /* XXX: we'll truncate later */
    792  1.2   itojun 
    793  1.2   itojun 		 break;
    794  1.2   itojun 	 default:
    795  1.2   itojun 		 /*
    796  1.2   itojun 		  * XXX: We must return a reply with the ICMP6 code
    797  1.2   itojun 		  * `unknown Qtype' in this case. However we regard the case
    798  1.2   itojun 		  * as an FQDN query for backward compatibility.
    799  1.2   itojun 		  * Older versions set a random value to this field,
    800  1.2   itojun 		  * so it rarely varies in the defined qtypes.
    801  1.2   itojun 		  * But the mechanism is not reliable...
    802  1.2   itojun 		  * maybe we should obsolete older versions.
    803  1.2   itojun 		  */
    804  1.2   itojun 		 qtype = NI_QTYPE_FQDN;
    805  1.2   itojun 		 replylen += offsetof(struct ni_reply_fqdn, ni_fqdn_name) +
    806  1.2   itojun 			 hostnamelen;
    807  1.2   itojun 		 break;
    808  1.2   itojun 	}
    809  1.2   itojun 
    810  1.2   itojun 	/* allocate a mbuf to reply. */
    811  1.2   itojun 	MGETHDR(n, M_DONTWAIT, m->m_type);
    812  1.2   itojun 	if (n == NULL)
    813  1.2   itojun 		return(NULL);
    814  1.2   itojun 	M_COPY_PKTHDR(n, m); /* just for recvif */
    815  1.2   itojun 	if (replylen > MHLEN) {
    816  1.2   itojun 		if (replylen > MCLBYTES)
    817  1.2   itojun 			 /*
    818  1.2   itojun 			  * XXX: should we try to allocate more? But MCLBYTES is
    819  1.2   itojun 			  * probably much larger than IPV6_MMTU...
    820  1.2   itojun 			  */
    821  1.2   itojun 			goto bad;
    822  1.2   itojun 		MCLGET(n, M_DONTWAIT);
    823  1.2   itojun 		if ((n->m_flags & M_EXT) == 0) {
    824  1.2   itojun 			goto bad;
    825  1.2   itojun 		}
    826  1.2   itojun 	}
    827  1.2   itojun 	n->m_pkthdr.len = n->m_len = replylen;
    828  1.2   itojun 
    829  1.2   itojun 	/* copy mbuf header and IPv6 + Node Information base headers */
    830  1.2   itojun 	bcopy(mtod(m, caddr_t), mtod(n, caddr_t), sizeof(struct ip6_hdr));
    831  1.2   itojun 	nni6 = (struct icmp6_nodeinfo *)(mtod(n, struct ip6_hdr *) + 1);
    832  1.2   itojun 	bcopy(mtod(m, caddr_t) + off, (caddr_t)nni6, sizeof(struct icmp6_nodeinfo));
    833  1.2   itojun 
    834  1.2   itojun 	/* qtype dependent procedure */
    835  1.2   itojun 	switch (qtype) {
    836  1.2   itojun 	 case NI_QTYPE_NOOP:
    837  1.2   itojun 		 nni6->ni_flags = 0;
    838  1.2   itojun 		 break;
    839  1.2   itojun 	 case NI_QTYPE_SUPTYPES:
    840  1.2   itojun 		 goto bad;	/* xxx: to be implemented */
    841  1.2   itojun 		 break;
    842  1.2   itojun 	 case NI_QTYPE_FQDN:
    843  1.2   itojun 		 if (hostnamelen > 255) { /* XXX: rare case, but may happen */
    844  1.2   itojun 			 printf("ni6_input: "
    845  1.2   itojun 				"hostname length(%d) is too large for reply\n",
    846  1.2   itojun 				hostnamelen);
    847  1.2   itojun 			 goto bad;
    848  1.2   itojun 		 }
    849  1.2   itojun 		 fqdn = (struct ni_reply_fqdn *)(mtod(n, caddr_t) +
    850  1.2   itojun 						 sizeof(struct ip6_hdr) +
    851  1.2   itojun 						 sizeof(struct icmp6_nodeinfo));
    852  1.2   itojun 		 nni6->ni_flags = 0; /* XXX: meaningless TTL */
    853  1.2   itojun 		 fqdn->ni_fqdn_ttl = 0;	/* ditto. */
    854  1.2   itojun 		 fqdn->ni_fqdn_namelen = hostnamelen;
    855  1.2   itojun 		 bcopy(hostname, &fqdn->ni_fqdn_name[0], hostnamelen);
    856  1.2   itojun 		 break;
    857  1.2   itojun 	 case NI_QTYPE_NODEADDR:
    858  1.2   itojun 	 {
    859  1.2   itojun 		 int lenlim, copied;
    860  1.2   itojun 
    861  1.2   itojun 		 if (n->m_flags & M_EXT)
    862  1.2   itojun 			 lenlim = MCLBYTES - sizeof(struct ip6_hdr) -
    863  1.2   itojun 				 sizeof(struct icmp6_nodeinfo);
    864  1.2   itojun 		 else
    865  1.2   itojun 			 lenlim = MHLEN - sizeof(struct ip6_hdr) -
    866  1.2   itojun 				 sizeof(struct icmp6_nodeinfo);
    867  1.2   itojun 		 copied = ni6_store_addrs(ni6, nni6, ifp, lenlim);
    868  1.2   itojun 		 /* XXX: reset mbuf length */
    869  1.2   itojun 		 n->m_pkthdr.len = n->m_len = sizeof(struct ip6_hdr) +
    870  1.2   itojun 			 sizeof(struct icmp6_nodeinfo) + copied;
    871  1.2   itojun 		 break;
    872  1.2   itojun 	 }
    873  1.2   itojun 	 default:
    874  1.2   itojun 		 break;		/* XXX impossible! */
    875  1.2   itojun 	}
    876  1.2   itojun 
    877  1.2   itojun 	nni6->ni_type = ICMP6_NI_REPLY;
    878  1.2   itojun 	nni6->ni_code = ICMP6_NI_SUCESS;
    879  1.2   itojun 	return(n);
    880  1.2   itojun 
    881  1.2   itojun   bad:
    882  1.2   itojun 	if (n)
    883  1.2   itojun 		m_freem(n);
    884  1.2   itojun 	return(NULL);
    885  1.2   itojun }
    886  1.2   itojun #undef hostnamelen
    887  1.2   itojun 
    888  1.2   itojun /*
    889  1.2   itojun  * calculate the number of addresses to be returned in the node info reply.
    890  1.2   itojun  */
    891  1.2   itojun static int
    892  1.2   itojun ni6_addrs(ni6, m, ifpp)
    893  1.2   itojun 	struct icmp6_nodeinfo *ni6;
    894  1.2   itojun 	struct mbuf *m;
    895  1.2   itojun 	struct ifnet **ifpp;
    896  1.2   itojun {
    897  1.2   itojun 	register struct ifnet *ifp;
    898  1.2   itojun 	register struct in6_ifaddr *ifa6;
    899  1.2   itojun 	register struct ifaddr *ifa;
    900  1.2   itojun 	struct ip6_hdr *ip6 = mtod(m, struct ip6_hdr *);
    901  1.2   itojun 	int addrs = 0, addrsofif, iffound = 0;
    902  1.2   itojun 
    903  1.2   itojun #ifdef __NetBSD__
    904  1.2   itojun 	for (ifp = TAILQ_FIRST(&ifnet); ifp; ifp = TAILQ_NEXT(ifp, if_list))
    905  1.2   itojun #else
    906  1.2   itojun 	for (ifp = ifnet; ifp; ifp = ifp->if_next)
    907  1.2   itojun #endif
    908  1.2   itojun 	{
    909  1.2   itojun 		addrsofif = 0;
    910  1.2   itojun #ifdef __NetBSD__
    911  1.2   itojun 		for (ifa = ifp->if_addrlist.tqh_first; ifa;
    912  1.2   itojun 		     ifa = ifa->ifa_list.tqe_next)
    913  1.2   itojun #else
    914  1.2   itojun 		for (ifa = ifp->if_addrlist; ifa; ifa = ifa->ifa_next)
    915  1.2   itojun #endif
    916  1.2   itojun 		{
    917  1.2   itojun 			if (ifa->ifa_addr->sa_family != AF_INET6)
    918  1.2   itojun 				continue;
    919  1.2   itojun 			ifa6 = (struct in6_ifaddr *)ifa;
    920  1.2   itojun 
    921  1.2   itojun 			if (!(ni6->ni_flags & NI_NODEADDR_FLAG_ALL) &&
    922  1.2   itojun 			    IN6_ARE_ADDR_EQUAL(&ip6->ip6_dst,
    923  1.2   itojun 					       &ifa6->ia_addr.sin6_addr))
    924  1.2   itojun 				iffound = 1;
    925  1.2   itojun 
    926  1.2   itojun 			if (ifa6->ia6_flags & IN6_IFF_ANYCAST)
    927  1.2   itojun 				continue; /* we need only unicast addresses */
    928  1.2   itojun 
    929  1.2   itojun 			if ((ni6->ni_flags & (NI_NODEADDR_FLAG_LINKLOCAL |
    930  1.2   itojun 					      NI_NODEADDR_FLAG_SITELOCAL |
    931  1.2   itojun 					      NI_NODEADDR_FLAG_GLOBAL)) == 0)
    932  1.2   itojun 				continue;
    933  1.2   itojun 
    934  1.2   itojun 			/* What do we have to do about ::1? */
    935  1.2   itojun 			switch(in6_addrscope(&ifa6->ia_addr.sin6_addr)) {
    936  1.2   itojun 			 case IPV6_ADDR_SCOPE_LINKLOCAL:
    937  1.2   itojun 				if (ni6->ni_flags & NI_NODEADDR_FLAG_LINKLOCAL)
    938  1.2   itojun 					addrsofif++;
    939  1.2   itojun 				break;
    940  1.2   itojun 			 case IPV6_ADDR_SCOPE_SITELOCAL:
    941  1.2   itojun 				if (ni6->ni_flags & NI_NODEADDR_FLAG_SITELOCAL)
    942  1.2   itojun 					addrsofif++;
    943  1.2   itojun 				break;
    944  1.2   itojun 			 case IPV6_ADDR_SCOPE_GLOBAL:
    945  1.2   itojun 				 if (ni6->ni_flags & NI_NODEADDR_FLAG_GLOBAL)
    946  1.2   itojun 					 addrsofif++;
    947  1.2   itojun 				 break;
    948  1.2   itojun 			 default:
    949  1.2   itojun 				 continue;
    950  1.2   itojun 			}
    951  1.2   itojun 		}
    952  1.2   itojun 		if (iffound) {
    953  1.2   itojun 			*ifpp = ifp;
    954  1.2   itojun 			return(addrsofif);
    955  1.2   itojun 		}
    956  1.2   itojun 
    957  1.2   itojun 		addrs += addrsofif;
    958  1.2   itojun 	}
    959  1.2   itojun 
    960  1.2   itojun 	return(addrs);
    961  1.2   itojun }
    962  1.2   itojun 
    963  1.2   itojun static int
    964  1.2   itojun ni6_store_addrs(ni6, nni6, ifp0, resid)
    965  1.2   itojun 	struct icmp6_nodeinfo *ni6, *nni6;
    966  1.2   itojun 	struct ifnet *ifp0;
    967  1.2   itojun 	int resid;
    968  1.2   itojun {
    969  1.2   itojun #ifdef __NetBSD__
    970  1.2   itojun 	register struct ifnet *ifp = ifp0 ? ifp0 : TAILQ_FIRST(&ifnet);
    971  1.2   itojun #else
    972  1.2   itojun 	register struct ifnet *ifp = ifp0 ? ifp0 : ifnet;
    973  1.2   itojun #endif
    974  1.2   itojun 	register struct in6_ifaddr *ifa6;
    975  1.2   itojun 	register struct ifaddr *ifa;
    976  1.2   itojun 	int docopy, copied = 0;
    977  1.2   itojun 	u_char *cp = (u_char *)(nni6 + 1);
    978  1.2   itojun 
    979  1.2   itojun 	if (ifp0 == NULL && !(ni6->ni_flags & NI_NODEADDR_FLAG_ALL))
    980  1.2   itojun 		return(0);	/* needless to copy */
    981  1.2   itojun 
    982  1.2   itojun #ifdef __NetBSD__
    983  1.2   itojun 	for (; ifp; ifp = TAILQ_NEXT(ifp, if_list))
    984  1.2   itojun #else
    985  1.2   itojun 	for (; ifp; ifp = ifp->if_next)
    986  1.2   itojun #endif
    987  1.2   itojun 	{
    988  1.2   itojun #ifdef __NetBSD__
    989  1.2   itojun 		for (ifa = ifp->if_addrlist.tqh_first; ifa;
    990  1.2   itojun 		     ifa = ifa->ifa_list.tqe_next)
    991  1.2   itojun #else
    992  1.2   itojun 		for (ifa = ifp->if_addrlist; ifa; ifa = ifa->ifa_next)
    993  1.2   itojun #endif
    994  1.2   itojun 		{
    995  1.2   itojun 			docopy = 0;
    996  1.2   itojun 
    997  1.2   itojun 			if (ifa->ifa_addr->sa_family != AF_INET6)
    998  1.2   itojun 				continue;
    999  1.2   itojun 			ifa6 = (struct in6_ifaddr *)ifa;
   1000  1.2   itojun 
   1001  1.2   itojun 			if (ifa6->ia6_flags & IN6_IFF_ANYCAST)
   1002  1.2   itojun 				continue; /* we need only unicast addresses */
   1003  1.2   itojun 
   1004  1.2   itojun 			/* What do we have to do about ::1? */
   1005  1.2   itojun 			switch(in6_addrscope(&ifa6->ia_addr.sin6_addr)) {
   1006  1.2   itojun 			 case IPV6_ADDR_SCOPE_LINKLOCAL:
   1007  1.2   itojun 				if (ni6->ni_flags & NI_NODEADDR_FLAG_LINKLOCAL)
   1008  1.2   itojun 					docopy = 1;
   1009  1.2   itojun 				break;
   1010  1.2   itojun 			 case IPV6_ADDR_SCOPE_SITELOCAL:
   1011  1.2   itojun 				if (ni6->ni_flags & NI_NODEADDR_FLAG_SITELOCAL)
   1012  1.2   itojun 					docopy = 1;
   1013  1.2   itojun 				break;
   1014  1.2   itojun 			 case IPV6_ADDR_SCOPE_GLOBAL:
   1015  1.2   itojun 				 if (ni6->ni_flags & NI_NODEADDR_FLAG_GLOBAL)
   1016  1.2   itojun 					 docopy = 1;
   1017  1.2   itojun 				 break;
   1018  1.2   itojun 			 default:
   1019  1.2   itojun 				 continue;
   1020  1.2   itojun 			}
   1021  1.2   itojun 
   1022  1.2   itojun 			if (docopy) {
   1023  1.2   itojun 				if (resid < sizeof(struct in6_addr)) {
   1024  1.2   itojun 					/*
   1025  1.2   itojun 					 * We give up much more copy.
   1026  1.2   itojun 					 * Set the truncate flag and return.
   1027  1.2   itojun 					 */
   1028  1.2   itojun 					nni6->ni_flags |=
   1029  1.2   itojun 						NI_NODEADDR_FLAG_TRUNCATE;
   1030  1.2   itojun 					return(copied);
   1031  1.2   itojun 				}
   1032  1.2   itojun 				bcopy(&ifa6->ia_addr.sin6_addr, cp,
   1033  1.2   itojun 				      sizeof(struct in6_addr));
   1034  1.2   itojun 				/* XXX: KAME link-local hack; remove ifindex */
   1035  1.2   itojun 				if (IN6_IS_ADDR_LINKLOCAL(&ifa6->ia_addr.sin6_addr))
   1036  1.2   itojun 					((struct in6_addr *)cp)->s6_addr16[1] = 0;
   1037  1.2   itojun 				cp += sizeof(struct in6_addr);
   1038  1.2   itojun 				resid -= sizeof(struct in6_addr);
   1039  1.2   itojun 				copied += sizeof(struct in6_addr);
   1040  1.2   itojun 			}
   1041  1.2   itojun 		}
   1042  1.2   itojun 		if (ifp0)	/* we need search only on the specified IF */
   1043  1.2   itojun 			break;
   1044  1.2   itojun 	}
   1045  1.2   itojun 
   1046  1.2   itojun 	return(copied);
   1047  1.2   itojun }
   1048  1.2   itojun 
   1049  1.2   itojun /*
   1050  1.2   itojun  * XXX almost dup'ed code with rip6_input.
   1051  1.2   itojun  */
   1052  1.2   itojun static int
   1053  1.2   itojun icmp6_rip6_input(mp, off)
   1054  1.2   itojun 	struct	mbuf **mp;
   1055  1.2   itojun 	int	off;
   1056  1.2   itojun {
   1057  1.2   itojun 	struct mbuf *m = *mp;
   1058  1.2   itojun 	register struct ip6_hdr *ip6 = mtod(m, struct ip6_hdr *);
   1059  1.2   itojun 	register struct in6pcb *in6p;
   1060  1.2   itojun 	struct in6pcb *last = NULL;
   1061  1.2   itojun 	struct sockaddr_in6 rip6src;
   1062  1.2   itojun 	struct icmp6_hdr *icmp6;
   1063  1.2   itojun 	struct mbuf *opts = NULL;
   1064  1.2   itojun 
   1065  1.2   itojun 	/* this is assumed to be safe. */
   1066  1.2   itojun 	icmp6 = (struct icmp6_hdr *)((caddr_t)ip6 + off);
   1067  1.2   itojun 
   1068  1.2   itojun 	bzero(&rip6src, sizeof(rip6src));
   1069  1.2   itojun 	rip6src.sin6_len = sizeof(struct sockaddr_in6);
   1070  1.2   itojun 	rip6src.sin6_family = AF_INET6;
   1071  1.2   itojun 	rip6src.sin6_addr = ip6->ip6_src;
   1072  1.2   itojun 	if (IN6_IS_SCOPE_LINKLOCAL(&rip6src.sin6_addr))
   1073  1.2   itojun 		rip6src.sin6_addr.s6_addr16[1] = 0;
   1074  1.2   itojun 	if (m->m_pkthdr.rcvif) {
   1075  1.2   itojun 		if (IN6_IS_SCOPE_LINKLOCAL(&rip6src.sin6_addr))
   1076  1.2   itojun 			rip6src.sin6_scope_id = m->m_pkthdr.rcvif->if_index;
   1077  1.2   itojun 		else
   1078  1.2   itojun 			rip6src.sin6_scope_id = 0;
   1079  1.2   itojun 	} else
   1080  1.2   itojun 		rip6src.sin6_scope_id = 0;
   1081  1.2   itojun 
   1082  1.2   itojun #if !defined(__FreeBSD__) || __FreeBSD__ < 3
   1083  1.2   itojun 	for (in6p = rawin6pcb.in6p_next;
   1084  1.2   itojun 	     in6p != &rawin6pcb; in6p = in6p->in6p_next)
   1085  1.2   itojun #else
   1086  1.2   itojun 	LIST_FOREACH(in6p, &ripcb, inp_list)
   1087  1.2   itojun #endif
   1088  1.2   itojun 	{
   1089  1.2   itojun #if defined(__FreeBSD__) && __FreeBSD__ >= 3
   1090  1.2   itojun 		if ((in6p->inp_vflag & INP_IPV6) == NULL)
   1091  1.2   itojun 			continue;
   1092  1.2   itojun #endif
   1093  1.2   itojun 		if (in6p->in6p_ip6_nxt != IPPROTO_ICMPV6)
   1094  1.2   itojun 			continue;
   1095  1.2   itojun 		if (!IN6_IS_ADDR_ANY(&in6p->in6p_laddr) &&
   1096  1.2   itojun 		   !IN6_ARE_ADDR_EQUAL(&in6p->in6p_laddr, &ip6->ip6_dst))
   1097  1.2   itojun 			continue;
   1098  1.2   itojun 		if (!IN6_IS_ADDR_ANY(&in6p->in6p_faddr) &&
   1099  1.2   itojun 		   !IN6_ARE_ADDR_EQUAL(&in6p->in6p_faddr, &ip6->ip6_src))
   1100  1.2   itojun 			continue;
   1101  1.2   itojun 		if (in6p->in6p_icmp6filt
   1102  1.2   itojun 		    && ICMP6_FILTER_WILLBLOCK(icmp6->icmp6_type,
   1103  1.2   itojun 				 in6p->in6p_icmp6filt))
   1104  1.2   itojun 			continue;
   1105  1.2   itojun 		if (last) {
   1106  1.2   itojun 			struct	mbuf *n;
   1107  1.2   itojun 			if ((n = m_copy(m, 0, (int)M_COPYALL)) != NULL) {
   1108  1.2   itojun 				if (last->in6p_flags & IN6P_CONTROLOPTS)
   1109  1.2   itojun 					ip6_savecontrol(last, &opts, ip6, n);
   1110  1.2   itojun 				/* strip intermediate headers */
   1111  1.2   itojun 				m_adj(n, off);
   1112  1.2   itojun 				if (sbappendaddr(&last->in6p_socket->so_rcv,
   1113  1.2   itojun 						 (struct sockaddr *)&rip6src,
   1114  1.2   itojun 						 n, opts) == 0) {
   1115  1.2   itojun 					/* should notify about lost packet */
   1116  1.2   itojun 					m_freem(n);
   1117  1.2   itojun 					if (opts)
   1118  1.2   itojun 						m_freem(opts);
   1119  1.2   itojun 				} else
   1120  1.2   itojun 					sorwakeup(last->in6p_socket);
   1121  1.2   itojun 				opts = NULL;
   1122  1.2   itojun 			}
   1123  1.2   itojun 		}
   1124  1.2   itojun 		last = in6p;
   1125  1.2   itojun 	}
   1126  1.2   itojun 	if (last) {
   1127  1.2   itojun 		if (last->in6p_flags & IN6P_CONTROLOPTS)
   1128  1.2   itojun 			ip6_savecontrol(last, &opts, ip6, m);
   1129  1.2   itojun 		/* strip intermediate headers */
   1130  1.2   itojun 		m_adj(m, off);
   1131  1.2   itojun 		if (sbappendaddr(&last->in6p_socket->so_rcv,
   1132  1.2   itojun 				(struct sockaddr *)&rip6src, m, opts) == 0) {
   1133  1.2   itojun 			m_freem(m);
   1134  1.2   itojun 			if (opts)
   1135  1.2   itojun 				m_freem(opts);
   1136  1.2   itojun 		} else
   1137  1.2   itojun 			sorwakeup(last->in6p_socket);
   1138  1.2   itojun 	} else {
   1139  1.2   itojun 		m_freem(m);
   1140  1.2   itojun 		ip6stat.ip6s_delivered--;
   1141  1.2   itojun 	}
   1142  1.2   itojun 	return IPPROTO_DONE;
   1143  1.2   itojun }
   1144  1.2   itojun 
   1145  1.2   itojun /*
   1146  1.2   itojun  * Reflect the ip6 packet back to the source.
   1147  1.2   itojun  * The caller MUST check if the destination is multicast or not.
   1148  1.2   itojun  * This function is usually called with a unicast destination which
   1149  1.2   itojun  * can be safely the source of the reply packet. But some exceptions
   1150  1.2   itojun  * exist(e.g. ECHOREPLY, PATCKET_TOOBIG, "10" in OPTION type).
   1151  1.2   itojun  * ``off'' points to the icmp6 header, counted from the top of the mbuf.
   1152  1.2   itojun  */
   1153  1.2   itojun void
   1154  1.2   itojun icmp6_reflect(m, off)
   1155  1.2   itojun 	struct	mbuf *m;
   1156  1.2   itojun 	size_t off;
   1157  1.2   itojun {
   1158  1.2   itojun 	struct ip6_hdr *ip6 = mtod(m, struct ip6_hdr *);
   1159  1.2   itojun 	struct icmp6_hdr *icmp6;
   1160  1.2   itojun 	struct in6_ifaddr *ia;
   1161  1.2   itojun 	struct in6_addr t, *src = 0;
   1162  1.2   itojun 	int plen = m->m_pkthdr.len - sizeof(struct ip6_hdr);
   1163  1.2   itojun #ifdef COMPAT_RFC1885
   1164  1.2   itojun 	int mtu = IPV6_MMTU;
   1165  1.2   itojun 	struct sockaddr_in6 *sin6 = &icmp6_reflect_rt.ro_dst;
   1166  1.2   itojun #endif
   1167  1.2   itojun 
   1168  1.2   itojun 	/*
   1169  1.2   itojun 	 * If there are extra headers between IPv6 and ICMPv6, strip
   1170  1.2   itojun 	 * off that header first.
   1171  1.2   itojun 	 */
   1172  1.2   itojun 	if (off != sizeof(struct ip6_hdr)) {
   1173  1.2   itojun 		size_t siz;
   1174  1.2   itojun 
   1175  1.2   itojun 		/* sanity checks */
   1176  1.2   itojun 		if (off < sizeof(struct ip6_hdr)) {
   1177  1.2   itojun 			printf("sanity fail: off=%x, sizeof(ip6)=%x in %s:%d\n",
   1178  1.4   itojun 			       (unsigned int)off,
   1179  1.4   itojun 			       (unsigned int)sizeof(struct ip6_hdr),
   1180  1.4   itojun 			       __FILE__, __LINE__);
   1181  1.2   itojun 			goto bad;
   1182  1.2   itojun 		}
   1183  1.2   itojun 		siz = off - sizeof(struct ip6_hdr);
   1184  1.2   itojun 		if (plen < siz) {
   1185  1.2   itojun 			printf("sanity fail: siz=%x, payloadlen=%x in %s:%d\n",
   1186  1.4   itojun 			       (unsigned int)siz, plen, __FILE__, __LINE__);
   1187  1.2   itojun 			goto bad;
   1188  1.2   itojun 		}
   1189  1.2   itojun 		IP6_EXTHDR_CHECK(m, 0, off, /*nothing*/);
   1190  1.2   itojun 		IP6_EXTHDR_CHECK(m, off, sizeof(struct icmp6_hdr), /*nothing*/);
   1191  1.2   itojun 
   1192  1.2   itojun 		bcopy((caddr_t)ip6,
   1193  1.2   itojun 			(caddr_t)(mtod(m, u_char *) + siz),
   1194  1.2   itojun 			sizeof(struct ip6_hdr));
   1195  1.2   itojun 		m->m_data += siz;
   1196  1.2   itojun 		m->m_len -= siz;
   1197  1.2   itojun 		m->m_pkthdr.len -= siz;
   1198  1.2   itojun 		ip6 = mtod(m, struct ip6_hdr *);
   1199  1.2   itojun 		ip6->ip6_nxt = IPPROTO_ICMPV6;
   1200  1.2   itojun 		plen -= siz;
   1201  1.2   itojun 	}
   1202  1.2   itojun 
   1203  1.2   itojun 	icmp6 = (struct icmp6_hdr *)(ip6 + 1);
   1204  1.2   itojun 
   1205  1.2   itojun 	t = ip6->ip6_dst;
   1206  1.2   itojun 	/*
   1207  1.2   itojun 	 * ip6_input() drops a packet if its src is multicast.
   1208  1.2   itojun 	 * So, the src is never multicast.
   1209  1.2   itojun 	 */
   1210  1.2   itojun 	ip6->ip6_dst = ip6->ip6_src;
   1211  1.2   itojun 
   1212  1.2   itojun 	/* XXX hack for link-local addresses */
   1213  1.2   itojun 	if (IN6_IS_ADDR_LINKLOCAL(&ip6->ip6_dst))
   1214  1.2   itojun 		ip6->ip6_dst.s6_addr16[1] =
   1215  1.2   itojun 			htons(m->m_pkthdr.rcvif->if_index);
   1216  1.2   itojun 	if (IN6_IS_ADDR_LINKLOCAL(&t))
   1217  1.2   itojun 		t.s6_addr16[1] = htons(m->m_pkthdr.rcvif->if_index);
   1218  1.2   itojun 
   1219  1.2   itojun #ifdef COMPAT_RFC1885
   1220  1.2   itojun 	/*
   1221  1.2   itojun 	 * xxx guess MTU
   1222  1.2   itojun 	 * RFC 1885 requires that echo reply should be truncated if it
   1223  1.2   itojun 	 * does not fit in with (return) path MTU, but the description was
   1224  1.2   itojun 	 * removed in the new spec.
   1225  1.2   itojun 	 */
   1226  1.2   itojun 	if (icmp6_reflect_rt.ro_rt == 0 ||
   1227  1.2   itojun 	    ! (IN6_ARE_ADDR_EQUAL(&sin6->sin6_addr, &ip6->ip6_dst))) {
   1228  1.2   itojun 		if (icmp6_reflect_rt.ro_rt) {
   1229  1.2   itojun #ifdef __FreeBSD__
   1230  1.2   itojun 			RTFREE(icmp6_reflect_rt.ro_rt);
   1231  1.2   itojun #endif
   1232  1.2   itojun #ifdef __bsdi__
   1233  1.2   itojun 			rtfree(icmp6_reflect_rt.ro_rt);
   1234  1.2   itojun #endif
   1235  1.2   itojun 			icmp6_reflect_rt.ro_rt = 0;
   1236  1.2   itojun 		}
   1237  1.2   itojun 		bzero(sin6, sizeof(*sin6));
   1238  1.2   itojun 		sin6->sin6_family = PF_INET6;
   1239  1.2   itojun 		sin6->sin6_len = sizeof(struct sockaddr_in6);
   1240  1.2   itojun 		sin6->sin6_addr = ip6->ip6_dst;
   1241  1.2   itojun 
   1242  1.2   itojun #ifdef __NetBSD__
   1243  1.2   itojun 		rtalloc((struct route *)&icmp6_reflect_rt.ro_rt);
   1244  1.2   itojun #else
   1245  1.2   itojun 		rtalloc_ign((struct route *)&icmp6_reflect_rt.ro_rt,
   1246  1.2   itojun 			    RTF_PRCLONING);
   1247  1.2   itojun #endif
   1248  1.2   itojun 	}
   1249  1.2   itojun 
   1250  1.2   itojun 	if (icmp6_reflect_rt.ro_rt == 0)
   1251  1.2   itojun 		goto bad;
   1252  1.2   itojun 
   1253  1.2   itojun 	if ((icmp6_reflect_rt.ro_rt->rt_flags & RTF_HOST)
   1254  1.2   itojun 	    && mtu < icmp6_reflect_rt.ro_rt->rt_ifp->if_mtu)
   1255  1.2   itojun 		mtu = icmp6_reflect_rt.ro_rt->rt_rmx.rmx_mtu;
   1256  1.2   itojun 
   1257  1.2   itojun 	if (mtu < m->m_pkthdr.len) {
   1258  1.2   itojun 		plen -= (m->m_pkthdr.len - mtu);
   1259  1.2   itojun 		m_adj(m, mtu - m->m_pkthdr.len);
   1260  1.2   itojun 	}
   1261  1.2   itojun #endif
   1262  1.2   itojun 	/*
   1263  1.2   itojun 	 * If the incoming packet was addressed directly to us(i.e. unicast),
   1264  1.2   itojun 	 * use dst as the src for the reply.
   1265  1.2   itojun 	 */
   1266  1.2   itojun 	for (ia = in6_ifaddr; ia; ia = ia->ia_next)
   1267  1.2   itojun 		if (IN6_ARE_ADDR_EQUAL(&t, &ia->ia_addr.sin6_addr) &&
   1268  1.2   itojun 		    (ia->ia6_flags & IN6_IFF_ANYCAST) == 0) {
   1269  1.2   itojun 			src = &t;
   1270  1.2   itojun 			break;
   1271  1.2   itojun 		}
   1272  1.2   itojun 	if (ia == NULL && IN6_IS_ADDR_LINKLOCAL(&t) && (m->m_flags & M_LOOP)) {
   1273  1.2   itojun 		/*
   1274  1.2   itojun 		 * This is the case if the dst is our link-local address
   1275  1.2   itojun 		 * and the sender is also ourseleves.
   1276  1.2   itojun 		 */
   1277  1.2   itojun 		src = &t;
   1278  1.2   itojun 	}
   1279  1.2   itojun 
   1280  1.2   itojun 	if (src == 0)
   1281  1.2   itojun 		/*
   1282  1.2   itojun 		 * We have not multicast routing yet. So this case matches
   1283  1.2   itojun 		 * to our multicast, our anycast or not to our unicast.
   1284  1.2   itojun 		 * Select a source address which has the same scope.
   1285  1.2   itojun 		 */
   1286  1.2   itojun 		if ((ia = in6_ifawithscope(m->m_pkthdr.rcvif, &t)) != 0)
   1287  1.2   itojun 			src = &IA6_SIN6(ia)->sin6_addr;
   1288  1.2   itojun 
   1289  1.2   itojun 	if (src == 0)
   1290  1.2   itojun 		goto bad;
   1291  1.2   itojun 
   1292  1.2   itojun 	ip6->ip6_src = *src;
   1293  1.2   itojun 
   1294  1.2   itojun 	ip6->ip6_flow = 0;
   1295  1.2   itojun 	ip6->ip6_vfc = IPV6_VERSION;
   1296  1.2   itojun 	ip6->ip6_nxt = IPPROTO_ICMPV6;
   1297  1.2   itojun 	if (m->m_pkthdr.rcvif) {
   1298  1.2   itojun 		/* XXX: This may not be the outgoing interface */
   1299  1.2   itojun 		ip6->ip6_hlim = nd_ifinfo[m->m_pkthdr.rcvif->if_index].chlim;
   1300  1.2   itojun 	}
   1301  1.2   itojun 
   1302  1.2   itojun 	icmp6->icmp6_cksum = 0;
   1303  1.2   itojun 	icmp6->icmp6_cksum = in6_cksum(m, IPPROTO_ICMPV6,
   1304  1.2   itojun 					sizeof(struct ip6_hdr), plen);
   1305  1.2   itojun 
   1306  1.2   itojun 	/*
   1307  1.2   itojun 	 * xxx option handling
   1308  1.2   itojun 	 */
   1309  1.2   itojun 
   1310  1.2   itojun 	m->m_flags &= ~(M_BCAST|M_MCAST);
   1311  1.2   itojun #ifdef IPSEC
   1312  1.2   itojun 	m->m_pkthdr.rcvif = NULL;
   1313  1.2   itojun #endif /*IPSEC*/
   1314  1.2   itojun 
   1315  1.2   itojun #ifdef COMPAT_RFC1885
   1316  1.2   itojun 	ip6_output(m, NULL, &icmp6_reflect_rt, 0, NULL);
   1317  1.2   itojun #else
   1318  1.2   itojun 	ip6_output(m, NULL, NULL, 0, NULL);
   1319  1.2   itojun #endif
   1320  1.2   itojun 
   1321  1.2   itojun 	return;
   1322  1.2   itojun 
   1323  1.2   itojun  bad:
   1324  1.2   itojun 	m_freem(m);
   1325  1.2   itojun 	return;
   1326  1.2   itojun }
   1327  1.2   itojun 
   1328  1.2   itojun void
   1329  1.2   itojun icmp6_fasttimo()
   1330  1.2   itojun {
   1331  1.2   itojun 	mld6_fasttimeo();
   1332  1.2   itojun }
   1333  1.2   itojun 
   1334  1.2   itojun void
   1335  1.2   itojun icmp6_redirect_input(m, off)
   1336  1.2   itojun 	register struct mbuf *m;
   1337  1.2   itojun 	int off;
   1338  1.2   itojun {
   1339  1.2   itojun 	struct ifnet *ifp = m->m_pkthdr.rcvif;
   1340  1.2   itojun 	struct ip6_hdr *ip6 = mtod(m, struct ip6_hdr *);
   1341  1.2   itojun 	struct nd_redirect *nd_rd = (struct nd_redirect *)((caddr_t)ip6 + off);
   1342  1.2   itojun 	int icmp6len = ntohs(ip6->ip6_plen);
   1343  1.2   itojun 	char *lladdr = NULL;
   1344  1.2   itojun 	int lladdrlen = 0;
   1345  1.2   itojun 	u_char *redirhdr = NULL;
   1346  1.2   itojun 	int redirhdrlen = 0;
   1347  1.2   itojun 	struct rtentry *rt = NULL;
   1348  1.2   itojun 	int is_router;
   1349  1.2   itojun 	int is_onlink;
   1350  1.2   itojun 	struct in6_addr src6 = ip6->ip6_src;
   1351  1.2   itojun 	struct in6_addr redtgt6 = nd_rd->nd_rd_target;
   1352  1.2   itojun 	struct in6_addr reddst6 = nd_rd->nd_rd_dst;
   1353  1.2   itojun 	union nd_opts ndopts;
   1354  1.2   itojun 
   1355  1.2   itojun 	if (!m || !ifp)
   1356  1.2   itojun 		return;
   1357  1.2   itojun 
   1358  1.2   itojun 	/* XXX if we are router, we don't update route by icmp6 redirect */
   1359  1.2   itojun 	if (ip6_forwarding)
   1360  1.2   itojun 		return;
   1361  1.2   itojun 	if (!icmp6_rediraccept)
   1362  1.2   itojun 		return;
   1363  1.2   itojun 
   1364  1.2   itojun 	if (IN6_IS_ADDR_LINKLOCAL(&redtgt6))
   1365  1.2   itojun 		redtgt6.s6_addr16[1] = htons(ifp->if_index);
   1366  1.2   itojun 	if (IN6_IS_ADDR_LINKLOCAL(&reddst6))
   1367  1.2   itojun 		reddst6.s6_addr16[1] = htons(ifp->if_index);
   1368  1.2   itojun 
   1369  1.2   itojun 	/* validation */
   1370  1.2   itojun 	if (!IN6_IS_ADDR_LINKLOCAL(&src6)) {
   1371  1.2   itojun 		log(LOG_ERR,
   1372  1.2   itojun 			"ICMP6 redirect sent from %s rejected; "
   1373  1.2   itojun 			"must be from linklocal\n", ip6_sprintf(&src6));
   1374  1.2   itojun 		return;
   1375  1.2   itojun 	}
   1376  1.2   itojun 	if (ip6->ip6_hlim != 255) {
   1377  1.2   itojun 		log(LOG_ERR,
   1378  1.2   itojun 			"ICMP6 redirect sent from %s rejected; "
   1379  1.2   itojun 			"hlim=%d (must be 255)\n",
   1380  1.2   itojun 			ip6_sprintf(&src6), ip6->ip6_hlim);
   1381  1.2   itojun 		return;
   1382  1.2   itojun 	}
   1383  1.2   itojun     {
   1384  1.2   itojun 	/* ip6->ip6_src must be equal to gw for icmp6->icmp6_reddst */
   1385  1.2   itojun 	struct sockaddr_in6 sin6;
   1386  1.2   itojun 	struct in6_addr *gw6;
   1387  1.2   itojun 
   1388  1.2   itojun 	bzero(&sin6, sizeof(sin6));
   1389  1.2   itojun 	sin6.sin6_family = AF_INET6;
   1390  1.2   itojun 	sin6.sin6_len = sizeof(struct sockaddr_in6);
   1391  1.2   itojun 	bcopy(&reddst6, &sin6.sin6_addr, sizeof(reddst6));
   1392  1.2   itojun 	rt = rtalloc1((struct sockaddr *)&sin6, 0
   1393  1.2   itojun #ifdef __FreeBSD__
   1394  1.2   itojun 		      , 0UL
   1395  1.2   itojun #endif
   1396  1.2   itojun 		      );
   1397  1.2   itojun 	if (rt) {
   1398  1.2   itojun 		gw6 = &(((struct sockaddr_in6 *)rt->rt_gateway)->sin6_addr);
   1399  1.2   itojun 		if (bcmp(&src6, gw6, sizeof(struct in6_addr)) != 0) {
   1400  1.2   itojun 			log(LOG_ERR,
   1401  1.2   itojun 				"ICMP6 redirect sent from %s rejected; "
   1402  1.2   itojun 				"ip src=%s, gw for %s=%s (must be same)\n",
   1403  1.2   itojun 				ip6_sprintf(&src6), ip6_sprintf(&src6),
   1404  1.2   itojun 				ip6_sprintf(&reddst6), ip6_sprintf(gw6));
   1405  1.2   itojun 			RTFREE(rt);
   1406  1.2   itojun 			return;
   1407  1.2   itojun 		}
   1408  1.2   itojun 	} else {
   1409  1.2   itojun 		log(LOG_ERR,
   1410  1.2   itojun 			"ICMP6 redirect sent from %s rejected; "
   1411  1.2   itojun 			"no route found for redirect destination %s\n",
   1412  1.2   itojun 			ip6_sprintf(&src6), ip6_sprintf(&reddst6));
   1413  1.2   itojun 		return;
   1414  1.2   itojun 	}
   1415  1.2   itojun 	RTFREE(rt);
   1416  1.2   itojun 	rt = NULL;
   1417  1.2   itojun     }
   1418  1.2   itojun 	if (IN6_IS_ADDR_MULTICAST(&reddst6)) {
   1419  1.2   itojun 		log(LOG_ERR,
   1420  1.2   itojun 			"ICMP6 redirect sent from %s rejected; "
   1421  1.2   itojun 			"redirect destination=%s (must be unicast)\n",
   1422  1.2   itojun 			ip6_sprintf(&src6), ip6_sprintf(&reddst6));
   1423  1.2   itojun 		return;
   1424  1.2   itojun 	}
   1425  1.2   itojun 
   1426  1.2   itojun 	is_router = is_onlink = 0;
   1427  1.2   itojun 	if (IN6_IS_ADDR_LINKLOCAL(&redtgt6))
   1428  1.2   itojun 		is_router = 1;	/* router case */
   1429  1.2   itojun 	if (bcmp(&redtgt6, &reddst6, sizeof(redtgt6)) == 0)
   1430  1.2   itojun 		is_onlink = 1;	/* on-link destination case */
   1431  1.2   itojun 	if (!is_router && !is_onlink) {
   1432  1.2   itojun 		log(LOG_ERR,
   1433  1.2   itojun 			"ICMP6 redirect sent from %s rejected; "
   1434  1.2   itojun 			"redirect target=%s, destination=%s\n",
   1435  1.2   itojun 			ip6_sprintf(&src6), ip6_sprintf(&redtgt6),
   1436  1.2   itojun 			ip6_sprintf(&reddst6));
   1437  1.2   itojun 		return;
   1438  1.2   itojun 	}
   1439  1.2   itojun 	/* validation passed */
   1440  1.2   itojun 
   1441  1.2   itojun 	icmp6len -= sizeof(*nd_rd);
   1442  1.2   itojun 	nd6_option_init(nd_rd + 1, icmp6len, &ndopts);
   1443  1.2   itojun 	if (nd6_options(&ndopts) < 0) {
   1444  1.2   itojun 		log(LOG_INFO, "icmp6_redirect_input: "
   1445  1.2   itojun 			"invalid ND option, rejected\n");
   1446  1.2   itojun 		return;
   1447  1.2   itojun 	}
   1448  1.2   itojun 
   1449  1.2   itojun 	if (ndopts.nd_opts_tgt_lladdr) {
   1450  1.2   itojun 		lladdr = (char *)(ndopts.nd_opts_tgt_lladdr + 1);
   1451  1.2   itojun 		lladdrlen = ndopts.nd_opts_tgt_lladdr->nd_opt_len << 3;
   1452  1.2   itojun 	}
   1453  1.2   itojun 
   1454  1.2   itojun 	if (ndopts.nd_opts_rh) {
   1455  1.2   itojun 		redirhdrlen = ndopts.nd_opts_rh->nd_opt_rh_len;
   1456  1.2   itojun 		redirhdr = (u_char *)(ndopts.nd_opts_rh + 1); /* xxx */
   1457  1.2   itojun 	}
   1458  1.2   itojun 
   1459  1.2   itojun 	if (lladdr && ((ifp->if_addrlen + 2 + 7) & ~7) != lladdrlen) {
   1460  1.2   itojun 		log(LOG_INFO,
   1461  1.2   itojun 			"icmp6_redirect_input: lladdrlen mismatch for %s "
   1462  1.2   itojun 			"(if %d, icmp6 packet %d)\n",
   1463  1.2   itojun 			ip6_sprintf(&redtgt6), ifp->if_addrlen, lladdrlen - 2);
   1464  1.2   itojun 	}
   1465  1.2   itojun 
   1466  1.2   itojun 	/* RFC 2461 8.3 */
   1467  1.2   itojun 	nd6_cache_lladdr(ifp, &redtgt6, lladdr, lladdrlen, ND_REDIRECT);
   1468  1.2   itojun 
   1469  1.2   itojun 	if (!is_onlink) {	/* better router case. perform rtredirect. */
   1470  1.2   itojun 		/* perform rtredirect */
   1471  1.2   itojun 		struct sockaddr_in6 sdst;
   1472  1.2   itojun 		struct sockaddr_in6 sgw;
   1473  1.2   itojun 		struct sockaddr_in6 ssrc;
   1474  1.2   itojun #ifdef __bsdi__
   1475  1.2   itojun 		extern int icmp_redirtimeout;	/*XXX*/
   1476  1.2   itojun #endif
   1477  1.2   itojun 
   1478  1.2   itojun 		bzero(&sdst, sizeof(sdst));
   1479  1.2   itojun 		bzero(&sgw, sizeof(sgw));
   1480  1.2   itojun 		bzero(&ssrc, sizeof(ssrc));
   1481  1.2   itojun 		sdst.sin6_family = sgw.sin6_family = ssrc.sin6_family = AF_INET6;
   1482  1.2   itojun 		sdst.sin6_len = sgw.sin6_len = ssrc.sin6_len =
   1483  1.2   itojun 			sizeof(struct sockaddr_in6);
   1484  1.2   itojun 		bcopy(&redtgt6, &sgw.sin6_addr, sizeof(struct in6_addr));
   1485  1.2   itojun 		bcopy(&reddst6, &sdst.sin6_addr, sizeof(struct in6_addr));
   1486  1.2   itojun 		bcopy(&src6, &ssrc.sin6_addr, sizeof(struct in6_addr));
   1487  1.2   itojun 		rtredirect((struct sockaddr *)&sdst, (struct sockaddr *)&sgw,
   1488  1.2   itojun 			   (struct sockaddr *)NULL, RTF_GATEWAY | RTF_HOST,
   1489  1.2   itojun 			   (struct sockaddr *)&ssrc,
   1490  1.2   itojun #if defined(__FreeBSD__) || defined(__NetBSD__)
   1491  1.2   itojun 			   (struct rtentry **)NULL
   1492  1.2   itojun #elif defined(__bsdi__)
   1493  1.2   itojun 			   icmp_redirtimeout /*XXX*/
   1494  1.2   itojun #endif /*__FreeBSD__, __NetBSD__, __bsdi__*/
   1495  1.2   itojun 			   );
   1496  1.2   itojun 	}
   1497  1.2   itojun 	/* finally update cached route in each socket via pfctlinput */
   1498  1.2   itojun 	{
   1499  1.2   itojun 		struct sockaddr_in6 sdst;
   1500  1.2   itojun 
   1501  1.2   itojun 		bzero(&sdst, sizeof(sdst));
   1502  1.2   itojun 		sdst.sin6_family = AF_INET6;
   1503  1.2   itojun 		sdst.sin6_len = sizeof(struct sockaddr_in6);
   1504  1.2   itojun 		bcopy(&reddst6, &sdst.sin6_addr, sizeof(struct in6_addr));
   1505  1.2   itojun 		pfctlinput(PRC_REDIRECT_HOST, (struct sockaddr *)&sdst);
   1506  1.2   itojun #ifdef IPSEC
   1507  1.2   itojun 		key_sa_routechange((struct sockaddr *)&sdst);
   1508  1.2   itojun #endif
   1509  1.2   itojun 	}
   1510  1.2   itojun }
   1511  1.2   itojun 
   1512  1.2   itojun void
   1513  1.2   itojun icmp6_redirect_output(m0, rt)
   1514  1.2   itojun 	struct mbuf *m0;
   1515  1.2   itojun 	struct rtentry *rt;
   1516  1.2   itojun {
   1517  1.2   itojun 	struct ifnet *ifp;	/* my outgoing interface */
   1518  1.2   itojun 	struct in6_addr *ifp_ll6;
   1519  1.2   itojun 	struct in6_addr *router_ll6;
   1520  1.2   itojun 	struct ip6_hdr *sip6;	/* m0 as struct ip6_hdr */
   1521  1.2   itojun 	struct mbuf *m = NULL;	/* newly allocated one */
   1522  1.2   itojun 	struct ip6_hdr *ip6;	/* m as struct ip6_hdr */
   1523  1.2   itojun 	struct nd_redirect *nd_rd;
   1524  1.2   itojun 	size_t maxlen;
   1525  1.2   itojun 	u_char *p;
   1526  1.2   itojun 
   1527  1.2   itojun 	/* if we are not router, we don't send icmp6 redirect */
   1528  1.2   itojun 	if (!ip6_forwarding || ip6_accept_rtadv)
   1529  1.2   itojun 		goto fail;
   1530  1.2   itojun 
   1531  1.2   itojun 	/* sanity check */
   1532  1.2   itojun 	if (!m0 || !rt || !(rt->rt_flags & RTF_UP) || !(ifp = rt->rt_ifp))
   1533  1.2   itojun 		goto fail;
   1534  1.5   itojun 
   1535  1.5   itojun 	/*
   1536  1.5   itojun 	 * Address check:
   1537  1.5   itojun 	 *  the source address must identify a neighbor, and
   1538  1.5   itojun 	 *  the destination address must not be a multicast address
   1539  1.5   itojun 	 *  [RFC 2461, sec 8.2]
   1540  1.5   itojun 	 */
   1541  1.2   itojun 	sip6 = mtod(m0, struct ip6_hdr *);
   1542  1.5   itojun 	if (nd6_is_addr_neighbor(&sip6->ip6_src, ifp) == 0)
   1543  1.5   itojun 		goto fail;
   1544  1.2   itojun 	if (IN6_IS_ADDR_MULTICAST(&sip6->ip6_dst))
   1545  1.2   itojun 		goto fail;	/* what should we do here? */
   1546  1.2   itojun 
   1547  1.2   itojun 	/* rate limit */
   1548  1.2   itojun 	if (icmp6_ratelimit(&sip6->ip6_src, ND_REDIRECT, 0))
   1549  1.2   itojun 		goto fail;
   1550  1.2   itojun 
   1551  1.2   itojun 	/*
   1552  1.2   itojun 	 * Since we are going to append up to 1280 bytes (= IPV6_MMTU),
   1553  1.2   itojun 	 * we almost always ask for an mbuf cluster for simplicity.
   1554  1.2   itojun 	 * (MHLEN < IPV6_MMTU is almost always true)
   1555  1.2   itojun 	 */
   1556  1.2   itojun 	MGETHDR(m, M_DONTWAIT, MT_HEADER);
   1557  1.2   itojun 	if (!m)
   1558  1.2   itojun 		goto fail;
   1559  1.2   itojun 	if (MHLEN < IPV6_MMTU)
   1560  1.2   itojun 		MCLGET(m, M_DONTWAIT);
   1561  1.2   itojun 	maxlen = (m->m_flags & M_EXT) ? MCLBYTES : MHLEN;
   1562  1.2   itojun 	maxlen = min(IPV6_MMTU, maxlen);
   1563  1.2   itojun 	/* just for safety */
   1564  1.2   itojun 	if (maxlen < sizeof(struct ip6_hdr) + sizeof(struct icmp6_hdr))
   1565  1.2   itojun 		goto fail;
   1566  1.2   itojun 
   1567  1.2   itojun 	{
   1568  1.2   itojun 		/* get ip6 linklocal address for ifp(my outgoing interface). */
   1569  1.2   itojun 		struct in6_ifaddr *ia = in6ifa_ifpforlinklocal(ifp);
   1570  1.2   itojun 		if (ia == NULL)
   1571  1.2   itojun 			goto fail;
   1572  1.2   itojun 		ifp_ll6 = &ia->ia_addr.sin6_addr;
   1573  1.2   itojun 	}
   1574  1.2   itojun 
   1575  1.2   itojun 	/* get ip6 linklocal address for the router. */
   1576  1.2   itojun 	if (rt->rt_gateway && (rt->rt_flags & RTF_GATEWAY)) {
   1577  1.2   itojun 		struct sockaddr_in6 *sin6;
   1578  1.2   itojun 		sin6 = (struct sockaddr_in6 *)rt->rt_gateway;
   1579  1.2   itojun 		router_ll6 = &sin6->sin6_addr;
   1580  1.2   itojun 		if (!IN6_IS_ADDR_LINKLOCAL(router_ll6))
   1581  1.2   itojun 			router_ll6 = (struct in6_addr *)NULL;
   1582  1.2   itojun 	} else
   1583  1.2   itojun 		router_ll6 = (struct in6_addr *)NULL;
   1584  1.2   itojun 
   1585  1.2   itojun 	/* ip6 */
   1586  1.2   itojun 	ip6 = mtod(m, struct ip6_hdr *);
   1587  1.2   itojun 	ip6->ip6_flow = 0;
   1588  1.2   itojun 	ip6->ip6_vfc = IPV6_VERSION;
   1589  1.2   itojun 	/* ip6->ip6_plen will be set later */
   1590  1.2   itojun 	ip6->ip6_nxt = IPPROTO_ICMPV6;
   1591  1.2   itojun 	ip6->ip6_hlim = 255;
   1592  1.2   itojun 	/* ip6->ip6_src must be linklocal addr for my outgoing if. */
   1593  1.2   itojun 	bcopy(ifp_ll6, &ip6->ip6_src, sizeof(struct in6_addr));
   1594  1.2   itojun 	bcopy(&sip6->ip6_src, &ip6->ip6_dst, sizeof(struct in6_addr));
   1595  1.2   itojun 
   1596  1.2   itojun 	/* ND Redirect */
   1597  1.2   itojun 	nd_rd = (struct nd_redirect *)(ip6 + 1);
   1598  1.2   itojun 	nd_rd->nd_rd_type = ND_REDIRECT;
   1599  1.2   itojun 	nd_rd->nd_rd_code = 0;
   1600  1.2   itojun 	nd_rd->nd_rd_reserved = 0;
   1601  1.2   itojun 	if (rt->rt_flags & RTF_GATEWAY) {
   1602  1.2   itojun 		/*
   1603  1.2   itojun 		 * nd_rd->nd_rd_target must be a link-local address in
   1604  1.2   itojun 		 * better router cases.
   1605  1.2   itojun 		 */
   1606  1.2   itojun 		if (!router_ll6)
   1607  1.2   itojun 			goto fail;
   1608  1.2   itojun 		bcopy(router_ll6, &nd_rd->nd_rd_target,
   1609  1.2   itojun 		      sizeof(nd_rd->nd_rd_target));
   1610  1.2   itojun 		bcopy(&sip6->ip6_dst, &nd_rd->nd_rd_dst,
   1611  1.2   itojun 		      sizeof(nd_rd->nd_rd_dst));
   1612  1.2   itojun 	} else {
   1613  1.2   itojun 		/* make sure redtgt == reddst */
   1614  1.2   itojun 		bcopy(&sip6->ip6_dst, &nd_rd->nd_rd_target,
   1615  1.2   itojun 		      sizeof(nd_rd->nd_rd_target));
   1616  1.2   itojun 		bcopy(&sip6->ip6_dst, &nd_rd->nd_rd_dst,
   1617  1.2   itojun 		      sizeof(nd_rd->nd_rd_dst));
   1618  1.2   itojun 	}
   1619  1.2   itojun 
   1620  1.2   itojun 	p = (u_char *)(nd_rd + 1);
   1621  1.2   itojun 
   1622  1.2   itojun 	if (!router_ll6)
   1623  1.2   itojun 		goto nolladdropt;
   1624  1.2   itojun 
   1625  1.2   itojun     {
   1626  1.2   itojun 	/* target lladdr option */
   1627  1.2   itojun 	struct rtentry *rt_router = NULL;
   1628  1.2   itojun 	int len;
   1629  1.2   itojun 	struct sockaddr_dl *sdl;
   1630  1.2   itojun 	struct nd_opt_hdr *nd_opt;
   1631  1.2   itojun 	char *lladdr;
   1632  1.2   itojun 
   1633  1.2   itojun 	rt_router = nd6_lookup(router_ll6, 0, ifp);
   1634  1.2   itojun 	if (!rt_router)
   1635  1.2   itojun 		goto nolladdropt;
   1636  1.2   itojun 	if (!(rt_router->rt_flags & RTF_GATEWAY)
   1637  1.2   itojun 	 && (rt_router->rt_flags & RTF_LLINFO)
   1638  1.2   itojun 	 && (rt_router->rt_gateway->sa_family == AF_LINK)
   1639  1.2   itojun 	 && (sdl = (struct sockaddr_dl *)rt_router->rt_gateway)) {
   1640  1.2   itojun 		nd_opt = (struct nd_opt_hdr *)p;
   1641  1.2   itojun 		nd_opt->nd_opt_type = ND_OPT_TARGET_LINKADDR;
   1642  1.2   itojun 		len = 2 + ifp->if_addrlen;
   1643  1.2   itojun 		len = (len + 7) & ~7;	/*round by 8*/
   1644  1.2   itojun 		nd_opt->nd_opt_len = len >> 3;
   1645  1.2   itojun 		p += len;
   1646  1.2   itojun 		lladdr = (char *)(nd_opt + 1);
   1647  1.2   itojun 		bcopy(LLADDR(sdl), lladdr, ifp->if_addrlen);
   1648  1.2   itojun 	}
   1649  1.2   itojun     }
   1650  1.2   itojun nolladdropt:;
   1651  1.2   itojun 
   1652  1.2   itojun 	m->m_pkthdr.len = m->m_len = p - (u_char *)ip6;
   1653  1.2   itojun 
   1654  1.2   itojun 	/* just to be safe */
   1655  1.2   itojun 	if (m0->m_flags & M_DECRYPTED)
   1656  1.2   itojun 		goto noredhdropt;
   1657  1.2   itojun 
   1658  1.2   itojun     {
   1659  1.2   itojun 	/* redirected header option */
   1660  1.2   itojun 	int len;
   1661  1.2   itojun 	struct nd_opt_rd_hdr *nd_opt_rh;
   1662  1.2   itojun 
   1663  1.2   itojun 	/*
   1664  1.2   itojun 	 * compute the maximum size for icmp6 redirect header option.
   1665  1.2   itojun 	 * XXX room for auth header?
   1666  1.2   itojun 	 */
   1667  1.2   itojun 	len = maxlen - (p - (u_char *)ip6);
   1668  1.2   itojun 	len &= ~7;
   1669  1.2   itojun 
   1670  1.2   itojun 	/* This is just for simplicity. */
   1671  1.2   itojun 	if (m0->m_pkthdr.len != m0->m_len) {
   1672  1.2   itojun 		if (m0->m_next) {
   1673  1.2   itojun 			m_freem(m0->m_next);
   1674  1.2   itojun 			m0->m_next = NULL;
   1675  1.2   itojun 		}
   1676  1.2   itojun 		m0->m_pkthdr.len = m0->m_len;
   1677  1.2   itojun 	}
   1678  1.2   itojun 
   1679  1.2   itojun 	/*
   1680  1.2   itojun 	 * Redirected header option spec (RFC2461 4.6.3) talks nothing
   1681  1.2   itojun 	 * about padding/trancate rule for the original IP packet.
   1682  1.2   itojun 	 * From the discussion on IPv6imp in Feb 1999, the consensus was:
   1683  1.2   itojun 	 * - "attach as much as possible" is the goal
   1684  1.2   itojun 	 * - pad if not aligned (original size can be guessed by original
   1685  1.2   itojun 	 *   ip6 header)
   1686  1.2   itojun 	 * Following code adds the padding if it is simple enough,
   1687  1.2   itojun 	 * and truncates if not.
   1688  1.2   itojun 	 */
   1689  1.2   itojun 	if (m0->m_next || m0->m_pkthdr.len != m0->m_len)
   1690  1.2   itojun 		panic("assumption failed in %s:%d\n", __FILE__, __LINE__);
   1691  1.2   itojun 
   1692  1.2   itojun 	if (len - sizeof(*nd_opt_rh) < m0->m_pkthdr.len) {
   1693  1.2   itojun 		/* not enough room, truncate */
   1694  1.2   itojun 		m0->m_pkthdr.len = m0->m_len = len - sizeof(*nd_opt_rh);
   1695  1.2   itojun 	} else {
   1696  1.2   itojun 		/* enough room, pad or truncate */
   1697  1.2   itojun 		size_t extra;
   1698  1.2   itojun 
   1699  1.2   itojun 		extra = m0->m_pkthdr.len % 8;
   1700  1.2   itojun 		if (extra) {
   1701  1.2   itojun 			/* pad if easy enough, truncate if not */
   1702  1.2   itojun 			if (8 - extra <= M_TRAILINGSPACE(m0)) {
   1703  1.2   itojun 				/* pad */
   1704  1.2   itojun 				m0->m_len += (8 - extra);
   1705  1.2   itojun 				m0->m_pkthdr.len += (8 - extra);
   1706  1.2   itojun 			} else {
   1707  1.2   itojun 				/* truncate */
   1708  1.2   itojun 				m0->m_pkthdr.len -= extra;
   1709  1.2   itojun 				m0->m_len -= extra;
   1710  1.2   itojun 			}
   1711  1.2   itojun 		}
   1712  1.2   itojun 		len = m0->m_pkthdr.len + sizeof(*nd_opt_rh);
   1713  1.2   itojun 		m0->m_pkthdr.len = m0->m_len = len - sizeof(*nd_opt_rh);
   1714  1.2   itojun 	}
   1715  1.2   itojun 
   1716  1.2   itojun 	nd_opt_rh = (struct nd_opt_rd_hdr *)p;
   1717  1.2   itojun 	bzero(nd_opt_rh, sizeof(*nd_opt_rh));
   1718  1.2   itojun 	nd_opt_rh->nd_opt_rh_type = ND_OPT_REDIRECTED_HEADER;
   1719  1.2   itojun 	nd_opt_rh->nd_opt_rh_len = len >> 3;
   1720  1.2   itojun 	p += sizeof(*nd_opt_rh);
   1721  1.2   itojun 	m->m_pkthdr.len = m->m_len = p - (u_char *)ip6;
   1722  1.2   itojun 
   1723  1.2   itojun 	/* connect m0 to m */
   1724  1.2   itojun 	m->m_next = m0;
   1725  1.2   itojun 	m->m_pkthdr.len = m->m_len + m0->m_len;
   1726  1.2   itojun     }
   1727  1.2   itojun noredhdropt:;
   1728  1.2   itojun 
   1729  1.2   itojun 	if (IN6_IS_ADDR_LINKLOCAL(&sip6->ip6_src))
   1730  1.2   itojun 		sip6->ip6_src.s6_addr16[1] = 0;
   1731  1.2   itojun 	if (IN6_IS_ADDR_LINKLOCAL(&sip6->ip6_dst))
   1732  1.2   itojun 		sip6->ip6_dst.s6_addr16[1] = 0;
   1733  1.2   itojun #if 0
   1734  1.2   itojun 	if (IN6_IS_ADDR_LINKLOCAL(&ip6->ip6_src))
   1735  1.2   itojun 		ip6->ip6_src.s6_addr16[1] = 0;
   1736  1.2   itojun 	if (IN6_IS_ADDR_LINKLOCAL(&ip6->ip6_dst))
   1737  1.2   itojun 		ip6->ip6_dst.s6_addr16[1] = 0;
   1738  1.2   itojun #endif
   1739  1.2   itojun 	if (IN6_IS_ADDR_LINKLOCAL(&nd_rd->nd_rd_target))
   1740  1.2   itojun 		nd_rd->nd_rd_target.s6_addr16[1] = 0;
   1741  1.2   itojun 	if (IN6_IS_ADDR_LINKLOCAL(&nd_rd->nd_rd_dst))
   1742  1.2   itojun 		nd_rd->nd_rd_dst.s6_addr16[1] = 0;
   1743  1.2   itojun 
   1744  1.2   itojun 	ip6->ip6_plen = htons(m->m_pkthdr.len - sizeof(struct ip6_hdr));
   1745  1.2   itojun 
   1746  1.2   itojun 	nd_rd->nd_rd_cksum = 0;
   1747  1.2   itojun 	nd_rd->nd_rd_cksum
   1748  1.2   itojun 		= in6_cksum(m, IPPROTO_ICMPV6, sizeof(*ip6), ntohs(ip6->ip6_plen));
   1749  1.2   itojun 
   1750  1.2   itojun 	/* send the packet to outside... */
   1751  1.2   itojun #ifdef IPSEC
   1752  1.2   itojun 	m->m_pkthdr.rcvif = NULL;
   1753  1.2   itojun #endif /*IPSEC*/
   1754  1.2   itojun 	ip6_output(m, NULL, NULL, 0, NULL);
   1755  1.2   itojun 	icmp6stat.icp6s_outhist[ND_REDIRECT]++;
   1756  1.2   itojun 
   1757  1.2   itojun 	return;
   1758  1.2   itojun 
   1759  1.2   itojun fail:
   1760  1.2   itojun 	if (m)
   1761  1.2   itojun 		m_freem(m);
   1762  1.2   itojun 	if (m0)
   1763  1.2   itojun 		m_freem(m0);
   1764  1.2   itojun }
   1765  1.2   itojun 
   1766  1.2   itojun /*
   1767  1.2   itojun  * ICMPv6 socket option processing.
   1768  1.2   itojun  */
   1769  1.2   itojun int
   1770  1.2   itojun icmp6_ctloutput(op, so, level, optname, mp)
   1771  1.2   itojun 	int op;
   1772  1.2   itojun 	struct socket *so;
   1773  1.2   itojun 	int level, optname;
   1774  1.2   itojun 	struct mbuf **mp;
   1775  1.2   itojun {
   1776  1.2   itojun 	register struct in6pcb *in6p = sotoin6pcb(so);
   1777  1.2   itojun 	register struct mbuf *m = *mp;
   1778  1.2   itojun 	int error = 0;
   1779  1.2   itojun 
   1780  1.2   itojun 	if (level != IPPROTO_ICMPV6) {
   1781  1.2   itojun 		error = EINVAL;
   1782  1.2   itojun 		if (op == PRCO_SETOPT && m)
   1783  1.2   itojun 			(void)m_free(m);
   1784  1.2   itojun 	} else switch(op) {
   1785  1.2   itojun 	 case PRCO_SETOPT:
   1786  1.2   itojun 		 switch (optname) {
   1787  1.2   itojun 		  case ICMP6_FILTER:
   1788  1.2   itojun 		  {
   1789  1.2   itojun 			  struct icmp6_filter *p;
   1790  1.2   itojun 
   1791  1.2   itojun 			  p = mtod(m, struct icmp6_filter *);
   1792  1.2   itojun 			  if (!p || !in6p->in6p_icmp6filt) {
   1793  1.2   itojun 				  error = EINVAL;
   1794  1.2   itojun 				  break;
   1795  1.2   itojun 			  }
   1796  1.2   itojun 			  bcopy(p, in6p->in6p_icmp6filt,
   1797  1.2   itojun 				sizeof(struct icmp6_filter));
   1798  1.2   itojun 			  error = 0;
   1799  1.2   itojun 			  break;
   1800  1.2   itojun 		  }
   1801  1.2   itojun 
   1802  1.2   itojun 		  default:
   1803  1.2   itojun 			  error = ENOPROTOOPT;
   1804  1.2   itojun 			  break;
   1805  1.2   itojun 		 }
   1806  1.2   itojun 		 if (m)
   1807  1.2   itojun 			 (void)m_free(m);
   1808  1.2   itojun 		 break;
   1809  1.2   itojun 
   1810  1.2   itojun 	 case PRCO_GETOPT:
   1811  1.2   itojun 		 switch (optname) {
   1812  1.2   itojun 		  case ICMP6_FILTER:
   1813  1.2   itojun 		  {
   1814  1.2   itojun 			  struct icmp6_filter *p;
   1815  1.2   itojun 
   1816  1.2   itojun 			  p = mtod(m, struct icmp6_filter *);
   1817  1.2   itojun 			  if (!p || !in6p->in6p_icmp6filt) {
   1818  1.2   itojun 				  error = EINVAL;
   1819  1.2   itojun 				  break;
   1820  1.2   itojun 			  }
   1821  1.2   itojun 			  bcopy(in6p->in6p_icmp6filt, p,
   1822  1.2   itojun 				sizeof(struct icmp6_filter));
   1823  1.2   itojun 			  error = 0;
   1824  1.2   itojun 			  break;
   1825  1.2   itojun 		  }
   1826  1.2   itojun 
   1827  1.2   itojun 		  default:
   1828  1.2   itojun 			  error = ENOPROTOOPT;
   1829  1.2   itojun 			  break;
   1830  1.2   itojun 		 }
   1831  1.2   itojun 		 break;
   1832  1.2   itojun 	}
   1833  1.2   itojun 
   1834  1.2   itojun 	return(error);
   1835  1.2   itojun }
   1836  1.2   itojun 
   1837  1.2   itojun /*
   1838  1.2   itojun  * Perform rate limit check.
   1839  1.2   itojun  * Returns 0 if it is okay to send the icmp6 packet.
   1840  1.2   itojun  * Returns 1 if the router SHOULD NOT send this icmp6 packet due to rate
   1841  1.2   itojun  * limitation.
   1842  1.2   itojun  *
   1843  1.2   itojun  * XXX per-destination/type check necessary?
   1844  1.2   itojun  */
   1845  1.2   itojun static int
   1846  1.2   itojun icmp6_ratelimit(dst, type, code)
   1847  1.2   itojun 	const struct in6_addr *dst;	/* not used at this moment */
   1848  1.2   itojun 	const int type;			/* not used at this moment */
   1849  1.2   itojun 	const int code;			/* not used at this moment */
   1850  1.2   itojun {
   1851  1.2   itojun 	struct timeval tp;
   1852  1.2   itojun 	long sec_diff, usec_diff;
   1853  1.2   itojun 
   1854  1.2   itojun 	/* If we are not doing rate limitation, it is always okay to send */
   1855  1.2   itojun 	if (!icmp6errratelim)
   1856  1.2   itojun 		return 0;
   1857  1.2   itojun 
   1858  1.2   itojun #if defined(__FreeBSD__) && __FreeBSD__ >= 3
   1859  1.2   itojun 	microtime(&tp);
   1860  1.2   itojun 	tp.tv_sec = time_second;
   1861  1.2   itojun #else
   1862  1.2   itojun 	tp = time;
   1863  1.2   itojun #endif
   1864  1.2   itojun 	if (tp.tv_sec < icmp6_nextsend.tv_sec
   1865  1.2   itojun 	 || (tp.tv_sec == icmp6_nextsend.tv_sec
   1866  1.2   itojun 	  && tp.tv_usec < icmp6_nextsend.tv_usec)) {
   1867  1.2   itojun 		/* The packet is subject to rate limit */
   1868  1.2   itojun 		return 1;
   1869  1.2   itojun 	}
   1870  1.2   itojun 	sec_diff = icmp6errratelim / 1000000;
   1871  1.2   itojun 	usec_diff = icmp6errratelim % 1000000;
   1872  1.2   itojun 	icmp6_nextsend.tv_sec = tp.tv_sec + sec_diff;
   1873  1.2   itojun 	if ((tp.tv_usec = tp.tv_usec + usec_diff) >= 1000000) {
   1874  1.2   itojun 		icmp6_nextsend.tv_sec++;
   1875  1.2   itojun 		icmp6_nextsend.tv_usec -= 1000000;
   1876  1.2   itojun 	}
   1877  1.2   itojun 
   1878  1.2   itojun 	/* it is okay to send this */
   1879  1.2   itojun 	return 0;
   1880  1.2   itojun }
   1881  1.8   itojun 
   1882  1.8   itojun #ifdef __NetBSD__
   1883  1.8   itojun static struct rtentry *
   1884  1.8   itojun icmp6_mtudisc_clone(dst)
   1885  1.8   itojun 	struct sockaddr *dst;
   1886  1.8   itojun {
   1887  1.8   itojun 	struct rtentry *rt;
   1888  1.8   itojun 	int    error;
   1889  1.8   itojun 
   1890  1.8   itojun 	rt = rtalloc1(dst, 1);
   1891  1.8   itojun 	if (rt == 0)
   1892  1.8   itojun 		return NULL;
   1893  1.8   itojun 
   1894  1.8   itojun 	/* If we didn't get a host route, allocate one */
   1895  1.8   itojun 	if ((rt->rt_flags & RTF_HOST) == 0) {
   1896  1.8   itojun 		struct rtentry *nrt;
   1897  1.8   itojun 
   1898  1.8   itojun 		error = rtrequest((int) RTM_ADD, dst,
   1899  1.8   itojun 		    (struct sockaddr *) rt->rt_gateway,
   1900  1.8   itojun 		    (struct sockaddr *) 0,
   1901  1.8   itojun 		    RTF_GATEWAY | RTF_HOST | RTF_DYNAMIC, &nrt);
   1902  1.8   itojun 		if (error) {
   1903  1.8   itojun 			rtfree(rt);
   1904  1.8   itojun 			rtfree(nrt);
   1905  1.8   itojun 			return NULL;
   1906  1.8   itojun 		}
   1907  1.8   itojun 		nrt->rt_rmx = rt->rt_rmx;
   1908  1.8   itojun 		rtfree(rt);
   1909  1.8   itojun 		rt = nrt;
   1910  1.8   itojun 	}
   1911  1.8   itojun 	error = rt_timer_add(rt, icmp6_mtudisc_timeout,
   1912  1.8   itojun 			icmp6_mtudisc_timeout_q);
   1913  1.8   itojun 	if (error) {
   1914  1.8   itojun 		rtfree(rt);
   1915  1.8   itojun 		return NULL;
   1916  1.8   itojun 	}
   1917  1.8   itojun 
   1918  1.8   itojun 	return rt;	/* caller need to call rtfree() */
   1919  1.8   itojun }
   1920  1.8   itojun 
   1921  1.8   itojun static void
   1922  1.8   itojun icmp6_mtudisc_timeout(rt, r)
   1923  1.8   itojun 	struct rtentry *rt;
   1924  1.8   itojun 	struct rttimer *r;
   1925  1.8   itojun {
   1926  1.8   itojun 	if (rt == NULL)
   1927  1.8   itojun 		panic("icmp6_mtudisc_timeout: bad route to timeout");
   1928  1.8   itojun 	if ((rt->rt_flags & (RTF_DYNAMIC | RTF_HOST)) ==
   1929  1.8   itojun 	    (RTF_DYNAMIC | RTF_HOST)) {
   1930  1.8   itojun 		rtrequest((int) RTM_DELETE, (struct sockaddr *)rt_key(rt),
   1931  1.8   itojun 		    rt->rt_gateway, rt_mask(rt), rt->rt_flags, 0);
   1932  1.8   itojun 	} else {
   1933  1.8   itojun 		if ((rt->rt_rmx.rmx_locks & RTV_MTU) == 0) {
   1934  1.8   itojun 			rt->rt_rmx.rmx_mtu = 0;
   1935  1.8   itojun 		}
   1936  1.8   itojun 	}
   1937  1.8   itojun }
   1938  1.8   itojun #endif /*__NetBSD__*/
   1939  1.2   itojun 
   1940  1.2   itojun #ifdef __bsdi__
   1941  1.2   itojun void
   1942  1.2   itojun icmp6_mtuexpire(rt, rtt)
   1943  1.2   itojun 	struct rtentry *rt;
   1944  1.2   itojun 	struct rttimer *rtt;
   1945  1.2   itojun {
   1946  1.2   itojun 	rt->rt_flags |= RTF_PROBEMTU;
   1947  1.2   itojun 	Free(rtt);
   1948  1.2   itojun }
   1949  1.2   itojun 
   1950  1.2   itojun int *icmp6_sysvars[] = ICMPV6CTL_VARS;
   1951  1.2   itojun 
   1952  1.2   itojun int
   1953  1.2   itojun icmp6_sysctl(name, namelen, oldp, oldlenp, newp, newlen)
   1954  1.2   itojun 	int *name;
   1955  1.2   itojun 	u_int namelen;
   1956  1.2   itojun 	void *oldp;
   1957  1.2   itojun 	size_t *oldlenp;
   1958  1.2   itojun 	void *newp;
   1959  1.2   itojun 	size_t newlen;
   1960  1.2   itojun {
   1961  1.2   itojun 	if (name[0] >= ICMPV6CTL_MAXID)
   1962  1.2   itojun 		return (EOPNOTSUPP);
   1963  1.2   itojun 	switch (name[0]) {
   1964  1.2   itojun #if 0
   1965  1.2   itojun 	ICMPV6CTL_ND6_PRUNE:
   1966  1.2   itojun 	ICMPV6CTL_ND6_DELAY:
   1967  1.2   itojun 	ICMPV6CTL_ND6_UMAXTRIES:
   1968  1.2   itojun 	ICMPV6CTL_ND6_MMAXTRIES:
   1969  1.2   itojun 	ICMPV6CTL_ND6_USELOOPBACK:
   1970  1.2   itojun 	ICMPV6CTL_ND6_PROXYALL:
   1971  1.2   itojun 		/* need to check the value. */
   1972  1.2   itojun #endif
   1973  1.2   itojun 	case ICMPV6CTL_STATS:
   1974  1.2   itojun 		return sysctl_rdtrunc(oldp, oldlenp, newp, &icmp6stat,
   1975  1.2   itojun 		    sizeof(icmp6stat));
   1976  1.2   itojun 
   1977  1.2   itojun 	default:
   1978  1.2   itojun 		return (sysctl_int_arr(icmp6_sysvars, name, namelen,
   1979  1.2   itojun 		    oldp, oldlenp, newp, newlen));
   1980  1.2   itojun 	}
   1981  1.2   itojun }
   1982  1.2   itojun #endif /*__bsdi__*/
   1983  1.2   itojun 
   1984  1.2   itojun #ifdef __NetBSD__
   1985  1.2   itojun #include <vm/vm.h>
   1986  1.2   itojun #include <sys/sysctl.h>
   1987  1.2   itojun int
   1988  1.2   itojun icmp6_sysctl(name, namelen, oldp, oldlenp, newp, newlen)
   1989  1.2   itojun 	int *name;
   1990  1.2   itojun 	u_int namelen;
   1991  1.2   itojun 	void *oldp;
   1992  1.2   itojun 	size_t *oldlenp;
   1993  1.2   itojun 	void *newp;
   1994  1.2   itojun 	size_t newlen;
   1995  1.2   itojun {
   1996  1.2   itojun 
   1997  1.2   itojun 	/* All sysctl names at this level are terminal. */
   1998  1.2   itojun 	if (namelen != 1)
   1999  1.2   itojun 		return ENOTDIR;
   2000  1.2   itojun 
   2001  1.2   itojun 	switch (name[0]) {
   2002  1.2   itojun 
   2003  1.2   itojun 	case ICMPV6CTL_REDIRACCEPT:
   2004  1.2   itojun 		return sysctl_int(oldp, oldlenp, newp, newlen,
   2005  1.2   itojun 				&icmp6_rediraccept);
   2006  1.2   itojun 	case ICMPV6CTL_REDIRTIMEOUT:
   2007  1.2   itojun 		return sysctl_int(oldp, oldlenp, newp, newlen,
   2008  1.2   itojun 				&icmp6_redirtimeout);
   2009  1.2   itojun 	case ICMPV6CTL_STATS:
   2010  1.2   itojun 		return sysctl_rdstruct(oldp, oldlenp, newp,
   2011  1.2   itojun 				&icmp6stat, sizeof(icmp6stat));
   2012  1.2   itojun 	case ICMPV6CTL_ERRRATELIMIT:
   2013  1.2   itojun 		return sysctl_int(oldp, oldlenp, newp, newlen,
   2014  1.2   itojun 				  &icmp6errratelim);
   2015  1.2   itojun 	case ICMPV6CTL_ND6_PRUNE:
   2016  1.2   itojun 		return sysctl_int(oldp, oldlenp, newp, newlen, &nd6_prune);
   2017  1.2   itojun 	case ICMPV6CTL_ND6_DELAY:
   2018  1.2   itojun 		return sysctl_int(oldp, oldlenp, newp, newlen, &nd6_delay);
   2019  1.2   itojun 	case ICMPV6CTL_ND6_UMAXTRIES:
   2020  1.2   itojun 		return sysctl_int(oldp, oldlenp, newp, newlen, &nd6_umaxtries);
   2021  1.2   itojun 	case ICMPV6CTL_ND6_MMAXTRIES:
   2022  1.2   itojun 		return sysctl_int(oldp, oldlenp, newp, newlen, &nd6_mmaxtries);
   2023  1.2   itojun 	case ICMPV6CTL_ND6_USELOOPBACK:
   2024  1.2   itojun 		return sysctl_int(oldp, oldlenp, newp, newlen,
   2025  1.2   itojun 				&nd6_useloopback);
   2026  1.2   itojun 	case ICMPV6CTL_ND6_PROXYALL:
   2027  1.2   itojun 		return sysctl_int(oldp, oldlenp, newp, newlen, &nd6_proxyall);
   2028  1.2   itojun 	default:
   2029  1.2   itojun 		return ENOPROTOOPT;
   2030  1.2   itojun 	}
   2031  1.2   itojun 	/* NOTREACHED */
   2032  1.2   itojun }
   2033  1.2   itojun #endif /* __NetBSD__ */
   2034