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