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