Home | History | Annotate | Line # | Download | only in netinet6
ip6_input.c revision 1.38
      1  1.38   itojun /*	$NetBSD: ip6_input.c,v 1.38 2001/03/16 12:22:34 itojun Exp $	*/
      2  1.37   itojun /*	$KAME: ip6_input.c,v 1.183 2001/03/01 15:15:23 itojun Exp $	*/
      3   1.3  thorpej 
      4   1.2   itojun /*
      5   1.2   itojun  * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project.
      6   1.2   itojun  * All rights reserved.
      7  1.21   itojun  *
      8   1.2   itojun  * Redistribution and use in source and binary forms, with or without
      9   1.2   itojun  * modification, are permitted provided that the following conditions
     10   1.2   itojun  * are met:
     11   1.2   itojun  * 1. Redistributions of source code must retain the above copyright
     12   1.2   itojun  *    notice, this list of conditions and the following disclaimer.
     13   1.2   itojun  * 2. Redistributions in binary form must reproduce the above copyright
     14   1.2   itojun  *    notice, this list of conditions and the following disclaimer in the
     15   1.2   itojun  *    documentation and/or other materials provided with the distribution.
     16   1.2   itojun  * 3. Neither the name of the project nor the names of its contributors
     17   1.2   itojun  *    may be used to endorse or promote products derived from this software
     18   1.2   itojun  *    without specific prior written permission.
     19  1.21   itojun  *
     20   1.2   itojun  * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
     21   1.2   itojun  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     22   1.2   itojun  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     23   1.2   itojun  * ARE DISCLAIMED.  IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
     24   1.2   itojun  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     25   1.2   itojun  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     26   1.2   itojun  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     27   1.2   itojun  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     28   1.2   itojun  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     29   1.2   itojun  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     30   1.2   itojun  * SUCH DAMAGE.
     31   1.2   itojun  */
     32   1.2   itojun 
     33   1.2   itojun /*
     34   1.2   itojun  * Copyright (c) 1982, 1986, 1988, 1993
     35   1.2   itojun  *	The Regents of the University of California.  All rights reserved.
     36   1.2   itojun  *
     37   1.2   itojun  * Redistribution and use in source and binary forms, with or without
     38   1.2   itojun  * modification, are permitted provided that the following conditions
     39   1.2   itojun  * are met:
     40   1.2   itojun  * 1. Redistributions of source code must retain the above copyright
     41   1.2   itojun  *    notice, this list of conditions and the following disclaimer.
     42   1.2   itojun  * 2. Redistributions in binary form must reproduce the above copyright
     43   1.2   itojun  *    notice, this list of conditions and the following disclaimer in the
     44   1.2   itojun  *    documentation and/or other materials provided with the distribution.
     45   1.2   itojun  * 3. All advertising materials mentioning features or use of this software
     46   1.2   itojun  *    must display the following acknowledgement:
     47   1.2   itojun  *	This product includes software developed by the University of
     48   1.2   itojun  *	California, Berkeley and its contributors.
     49   1.2   itojun  * 4. Neither the name of the University nor the names of its contributors
     50   1.2   itojun  *    may be used to endorse or promote products derived from this software
     51   1.2   itojun  *    without specific prior written permission.
     52   1.2   itojun  *
     53   1.2   itojun  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     54   1.2   itojun  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     55   1.2   itojun  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     56   1.2   itojun  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     57   1.2   itojun  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     58   1.2   itojun  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     59   1.2   itojun  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     60   1.2   itojun  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     61   1.2   itojun  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     62   1.2   itojun  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     63   1.2   itojun  * SUCH DAMAGE.
     64   1.2   itojun  *
     65   1.2   itojun  *	@(#)ip_input.c	8.2 (Berkeley) 1/4/94
     66   1.2   itojun  */
     67   1.2   itojun 
     68   1.2   itojun #include "opt_inet.h"
     69   1.4  thorpej #include "opt_ipsec.h"
     70  1.15  darrenr #include "opt_pfil_hooks.h"
     71   1.2   itojun 
     72   1.2   itojun #include <sys/param.h>
     73   1.2   itojun #include <sys/systm.h>
     74   1.2   itojun #include <sys/malloc.h>
     75   1.2   itojun #include <sys/mbuf.h>
     76   1.2   itojun #include <sys/domain.h>
     77   1.2   itojun #include <sys/protosw.h>
     78   1.2   itojun #include <sys/socket.h>
     79   1.2   itojun #include <sys/socketvar.h>
     80   1.2   itojun #include <sys/errno.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 #include <sys/proc.h>
     85   1.2   itojun 
     86   1.2   itojun #include <net/if.h>
     87   1.2   itojun #include <net/if_types.h>
     88   1.2   itojun #include <net/if_dl.h>
     89   1.2   itojun #include <net/route.h>
     90   1.2   itojun #include <net/netisr.h>
     91  1.15  darrenr #ifdef PFIL_HOOKS
     92  1.15  darrenr #include <net/pfil.h>
     93  1.15  darrenr #endif
     94   1.2   itojun 
     95   1.2   itojun #include <netinet/in.h>
     96   1.9   itojun #include <netinet/in_systm.h>
     97   1.9   itojun #ifdef INET
     98   1.9   itojun #include <netinet/ip.h>
     99   1.9   itojun #include <netinet/ip_icmp.h>
    100   1.9   itojun #endif /*INET*/
    101  1.14   itojun #include <netinet/ip6.h>
    102   1.2   itojun #include <netinet6/in6_var.h>
    103  1.11   itojun #include <netinet6/ip6_var.h>
    104   1.2   itojun #include <netinet6/in6_pcb.h>
    105  1.14   itojun #include <netinet/icmp6.h>
    106   1.2   itojun #include <netinet6/in6_ifattach.h>
    107   1.2   itojun #include <netinet6/nd6.h>
    108   1.9   itojun #include <netinet6/in6_prefix.h>
    109   1.2   itojun 
    110  1.37   itojun #ifdef IPSEC
    111  1.37   itojun #include <netinet6/ipsec.h>
    112  1.37   itojun #endif
    113  1.37   itojun 
    114   1.2   itojun #include <netinet6/ip6protosw.h>
    115   1.2   itojun 
    116   1.2   itojun /* we need it for NLOOP. */
    117   1.2   itojun #include "loop.h"
    118   1.2   itojun #include "faith.h"
    119   1.2   itojun 
    120   1.2   itojun #include "gif.h"
    121   1.2   itojun #include "bpfilter.h"
    122   1.2   itojun 
    123   1.9   itojun #include <net/net_osdep.h>
    124   1.9   itojun 
    125   1.2   itojun extern struct domain inet6domain;
    126   1.2   itojun 
    127   1.2   itojun u_char ip6_protox[IPPROTO_MAX];
    128   1.2   itojun static int ip6qmaxlen = IFQ_MAXLEN;
    129   1.2   itojun struct in6_ifaddr *in6_ifaddr;
    130   1.2   itojun struct ifqueue ip6intrq;
    131   1.2   itojun 
    132   1.2   itojun extern struct ifnet loif[NLOOP];
    133   1.2   itojun int ip6_forward_srcrt;			/* XXX */
    134   1.2   itojun int ip6_sourcecheck;			/* XXX */
    135   1.2   itojun int ip6_sourcecheck_interval;		/* XXX */
    136   1.9   itojun 
    137  1.29  thorpej #ifdef PFIL_HOOKS
    138  1.29  thorpej struct pfil_head inet6_pfil_hook;
    139  1.29  thorpej #endif
    140  1.29  thorpej 
    141   1.2   itojun struct ip6stat ip6stat;
    142   1.2   itojun 
    143   1.2   itojun static void ip6_init2 __P((void *));
    144   1.2   itojun 
    145   1.5   itojun static int ip6_hopopts_input __P((u_int32_t *, u_int32_t *, struct mbuf **, int *));
    146   1.2   itojun 
    147   1.2   itojun /*
    148   1.2   itojun  * IP6 initialization: fill in IP6 protocol switch table.
    149   1.2   itojun  * All protocols not implemented in kernel go to raw IP6 protocol handler.
    150   1.2   itojun  */
    151   1.2   itojun void
    152   1.2   itojun ip6_init()
    153   1.2   itojun {
    154  1.35   itojun 	struct ip6protosw *pr;
    155  1.35   itojun 	int i;
    156   1.2   itojun 	struct timeval tv;
    157   1.2   itojun 
    158   1.2   itojun 	pr = (struct ip6protosw *)pffindproto(PF_INET6, IPPROTO_RAW, SOCK_RAW);
    159   1.2   itojun 	if (pr == 0)
    160   1.2   itojun 		panic("ip6_init");
    161   1.2   itojun 	for (i = 0; i < IPPROTO_MAX; i++)
    162   1.2   itojun 		ip6_protox[i] = pr - inet6sw;
    163   1.2   itojun 	for (pr = (struct ip6protosw *)inet6domain.dom_protosw;
    164   1.2   itojun 	    pr < (struct ip6protosw *)inet6domain.dom_protoswNPROTOSW; pr++)
    165   1.2   itojun 		if (pr->pr_domain->dom_family == PF_INET6 &&
    166   1.2   itojun 		    pr->pr_protocol && pr->pr_protocol != IPPROTO_RAW)
    167   1.2   itojun 			ip6_protox[pr->pr_protocol] = pr - inet6sw;
    168   1.2   itojun 	ip6intrq.ifq_maxlen = ip6qmaxlen;
    169   1.2   itojun 	nd6_init();
    170   1.2   itojun 	frag6_init();
    171   1.2   itojun 	/*
    172   1.2   itojun 	 * in many cases, random() here does NOT return random number
    173   1.2   itojun 	 * as initialization during bootstrap time occur in fixed order.
    174   1.2   itojun 	 */
    175   1.2   itojun 	microtime(&tv);
    176   1.2   itojun 	ip6_flow_seq = random() ^ tv.tv_usec;
    177   1.2   itojun 
    178   1.2   itojun 	ip6_init2((void *)0);
    179  1.29  thorpej 
    180  1.29  thorpej #ifdef PFIL_HOOKS
    181  1.29  thorpej 	/* Register our Packet Filter hook. */
    182  1.33  thorpej 	inet6_pfil_hook.ph_type = PFIL_TYPE_AF;
    183  1.33  thorpej 	inet6_pfil_hook.ph_af   = AF_INET6;
    184  1.29  thorpej 	i = pfil_head_register(&inet6_pfil_hook);
    185  1.29  thorpej 	if (i != 0)
    186  1.29  thorpej 		printf("ip6_init: WARNING: unable to register pfil hook, "
    187  1.29  thorpej 		    "error %d\n", i);
    188  1.29  thorpej #endif /* PFIL_HOOKS */
    189   1.2   itojun }
    190   1.2   itojun 
    191   1.2   itojun static void
    192   1.2   itojun ip6_init2(dummy)
    193   1.2   itojun 	void *dummy;
    194   1.2   itojun {
    195   1.2   itojun 	/*
    196   1.2   itojun 	 * to route local address of p2p link to loopback,
    197  1.21   itojun 	 * assign loopback address first.
    198   1.2   itojun 	 */
    199  1.20   itojun 	in6_ifattach(&loif[0], NULL);
    200   1.2   itojun 
    201   1.2   itojun 	/* nd6_timer_init */
    202  1.19  thorpej 	callout_init(&nd6_timer_ch);
    203  1.19  thorpej 	callout_reset(&nd6_timer_ch, hz, nd6_timer, NULL);
    204   1.9   itojun 	/* router renumbering prefix list maintenance */
    205  1.19  thorpej 	callout_init(&in6_rr_timer_ch);
    206  1.19  thorpej 	callout_reset(&in6_rr_timer_ch, hz, in6_rr_timer, NULL);
    207   1.2   itojun }
    208   1.2   itojun 
    209   1.2   itojun /*
    210   1.2   itojun  * IP6 input interrupt handling. Just pass the packet to ip6_input.
    211   1.2   itojun  */
    212   1.2   itojun void
    213   1.2   itojun ip6intr()
    214   1.2   itojun {
    215   1.2   itojun 	int s;
    216   1.2   itojun 	struct mbuf *m;
    217   1.2   itojun 
    218   1.2   itojun 	for (;;) {
    219   1.2   itojun 		s = splimp();
    220   1.2   itojun 		IF_DEQUEUE(&ip6intrq, m);
    221   1.2   itojun 		splx(s);
    222   1.2   itojun 		if (m == 0)
    223   1.2   itojun 			return;
    224   1.2   itojun 		ip6_input(m);
    225   1.2   itojun 	}
    226   1.2   itojun }
    227   1.2   itojun 
    228   1.2   itojun extern struct	route_in6 ip6_forward_rt;
    229   1.2   itojun 
    230   1.2   itojun void
    231   1.2   itojun ip6_input(m)
    232   1.2   itojun 	struct mbuf *m;
    233   1.2   itojun {
    234   1.9   itojun 	struct ip6_hdr *ip6;
    235   1.2   itojun 	int off = sizeof(struct ip6_hdr), nest;
    236   1.2   itojun 	u_int32_t plen;
    237   1.5   itojun 	u_int32_t rtalert = ~0;
    238   1.2   itojun 	int nxt, ours = 0;
    239   1.9   itojun 	struct ifnet *deliverifp = NULL;
    240   1.2   itojun 
    241   1.2   itojun #ifdef IPSEC
    242   1.2   itojun 	/*
    243   1.2   itojun 	 * should the inner packet be considered authentic?
    244   1.2   itojun 	 * see comment in ah4_input().
    245   1.2   itojun 	 */
    246   1.2   itojun 	if (m) {
    247   1.2   itojun 		m->m_flags &= ~M_AUTHIPHDR;
    248   1.2   itojun 		m->m_flags &= ~M_AUTHIPDGM;
    249   1.2   itojun 	}
    250   1.2   itojun #endif
    251   1.9   itojun 
    252   1.2   itojun 	/*
    253   1.2   itojun 	 * mbuf statistics by kazu
    254   1.2   itojun 	 */
    255   1.2   itojun 	if (m->m_flags & M_EXT) {
    256   1.2   itojun 		if (m->m_next)
    257   1.2   itojun 			ip6stat.ip6s_mext2m++;
    258   1.2   itojun 		else
    259   1.2   itojun 			ip6stat.ip6s_mext1++;
    260   1.2   itojun 	} else {
    261   1.2   itojun 		if (m->m_next) {
    262   1.9   itojun 			if (m->m_flags & M_LOOP) {
    263   1.2   itojun 				ip6stat.ip6s_m2m[loif[0].if_index]++;	/*XXX*/
    264  1.22   itojun 			} else if (m->m_pkthdr.rcvif->if_index <= 31)
    265   1.2   itojun 				ip6stat.ip6s_m2m[m->m_pkthdr.rcvif->if_index]++;
    266   1.2   itojun 			else
    267   1.2   itojun 				ip6stat.ip6s_m2m[0]++;
    268   1.2   itojun 		} else
    269   1.2   itojun 			ip6stat.ip6s_m1++;
    270   1.2   itojun 	}
    271   1.2   itojun 
    272   1.9   itojun 	in6_ifstat_inc(m->m_pkthdr.rcvif, ifs6_in_receive);
    273   1.9   itojun 	ip6stat.ip6s_total++;
    274   1.9   itojun 
    275   1.9   itojun #ifndef PULLDOWN_TEST
    276   1.9   itojun 	/* XXX is the line really necessary? */
    277   1.2   itojun 	IP6_EXTHDR_CHECK(m, 0, sizeof(struct ip6_hdr), /*nothing*/);
    278   1.9   itojun #endif
    279   1.2   itojun 
    280   1.9   itojun 	if (m->m_len < sizeof(struct ip6_hdr)) {
    281   1.9   itojun 		struct ifnet *inifp;
    282   1.9   itojun 		inifp = m->m_pkthdr.rcvif;
    283   1.9   itojun 		if ((m = m_pullup(m, sizeof(struct ip6_hdr))) == 0) {
    284   1.9   itojun 			ip6stat.ip6s_toosmall++;
    285   1.9   itojun 			in6_ifstat_inc(inifp, ifs6_in_hdrerr);
    286   1.9   itojun 			return;
    287   1.9   itojun 		}
    288   1.2   itojun 	}
    289   1.2   itojun 
    290   1.2   itojun 	ip6 = mtod(m, struct ip6_hdr *);
    291   1.2   itojun 
    292   1.2   itojun 	if ((ip6->ip6_vfc & IPV6_VERSION_MASK) != IPV6_VERSION) {
    293   1.2   itojun 		ip6stat.ip6s_badvers++;
    294   1.9   itojun 		in6_ifstat_inc(m->m_pkthdr.rcvif, ifs6_in_hdrerr);
    295   1.2   itojun 		goto bad;
    296   1.2   itojun 	}
    297  1.15  darrenr 
    298  1.15  darrenr #ifdef PFIL_HOOKS
    299  1.15  darrenr 	/*
    300  1.15  darrenr 	 * Run through list of hooks for input packets.  If there are any
    301  1.15  darrenr 	 * filters which require that additional packets in the flow are
    302  1.15  darrenr 	 * not fast-forwarded, they must clear the M_CANFASTFWD flag.
    303  1.15  darrenr 	 * Note that filters must _never_ set this flag, as another filter
    304  1.15  darrenr 	 * in the list may have previously cleared it.
    305  1.15  darrenr 	 */
    306  1.29  thorpej 	if (pfil_run_hooks(&inet6_pfil_hook, &m, m->m_pkthdr.rcvif,
    307  1.29  thorpej 			   PFIL_IN) != 0)
    308  1.29  thorpej 		return;
    309  1.29  thorpej 	if (m == NULL)
    310  1.29  thorpej 		return;
    311  1.29  thorpej 	ip6 = mtod(m, struct ip6_hdr *);
    312  1.15  darrenr #endif /* PFIL_HOOKS */
    313  1.15  darrenr 
    314   1.2   itojun 
    315   1.2   itojun 	ip6stat.ip6s_nxthist[ip6->ip6_nxt]++;
    316   1.2   itojun 
    317  1.30  thorpej #ifdef ALTQ
    318  1.30  thorpej 	/* XXX Temporary until ALTQ is changed to use a pfil hook */
    319  1.30  thorpej 	if (altq_input != NULL && (*altq_input)(m, AF_INET6) == 0) {
    320  1.30  thorpej 		/* packet is dropped by traffic conditioner */
    321  1.30  thorpej 		return;
    322   1.9   itojun 	}
    323   1.9   itojun #endif
    324   1.9   itojun 
    325   1.2   itojun 	/*
    326   1.2   itojun 	 * Scope check
    327   1.2   itojun 	 */
    328   1.2   itojun 	if (IN6_IS_ADDR_MULTICAST(&ip6->ip6_src) ||
    329   1.2   itojun 	    IN6_IS_ADDR_UNSPECIFIED(&ip6->ip6_dst)) {
    330   1.2   itojun 		ip6stat.ip6s_badscope++;
    331   1.9   itojun 		in6_ifstat_inc(m->m_pkthdr.rcvif, ifs6_in_addrerr);
    332   1.2   itojun 		goto bad;
    333   1.2   itojun 	}
    334  1.13   itojun 	/*
    335  1.13   itojun 	 * The following check is not documented in the spec.  Malicious party
    336  1.13   itojun 	 * may be able to use IPv4 mapped addr to confuse tcp/udp stack and
    337  1.13   itojun 	 * bypass security checks (act as if it was from 127.0.0.1 by using
    338  1.13   itojun 	 * IPv6 src ::ffff:127.0.0.1).	Be cautious.
    339  1.35   itojun 	 *
    340  1.35   itojun 	 * This check chokes if we are in SIIT cloud.  As none of BSDs support
    341  1.35   itojun 	 * IPv4-less kernel compilation, we cannot support SIIT environment
    342  1.35   itojun 	 * at all.  So, it makes more sense for us to reject any malicious
    343  1.35   itojun 	 * packets for non-SIIT environment, than try to do a partical support
    344  1.35   itojun 	 * for SIIT environment.
    345  1.13   itojun 	 */
    346  1.13   itojun 	if (IN6_IS_ADDR_V4MAPPED(&ip6->ip6_src) ||
    347  1.13   itojun 	    IN6_IS_ADDR_V4MAPPED(&ip6->ip6_dst)) {
    348  1.13   itojun 		ip6stat.ip6s_badscope++;
    349  1.13   itojun 		in6_ifstat_inc(m->m_pkthdr.rcvif, ifs6_in_addrerr);
    350  1.13   itojun 		goto bad;
    351  1.13   itojun 	}
    352  1.17   itojun #if 0
    353  1.13   itojun 	/*
    354  1.17   itojun 	 * Reject packets with IPv4 compatible addresses (auto tunnel).
    355  1.17   itojun 	 *
    356  1.17   itojun 	 * The code forbids auto tunnel relay case in RFC1933 (the check is
    357  1.17   itojun 	 * stronger than RFC1933).  We may want to re-enable it if mech-xx
    358  1.17   itojun 	 * is revised to forbid relaying case.
    359  1.13   itojun 	 */
    360  1.13   itojun 	if (IN6_IS_ADDR_V4COMPAT(&ip6->ip6_src) ||
    361  1.13   itojun 	    IN6_IS_ADDR_V4COMPAT(&ip6->ip6_dst)) {
    362  1.13   itojun 		ip6stat.ip6s_badscope++;
    363  1.13   itojun 		in6_ifstat_inc(m->m_pkthdr.rcvif, ifs6_in_addrerr);
    364  1.13   itojun 		goto bad;
    365  1.13   itojun 	}
    366  1.13   itojun #endif
    367  1.35   itojun 
    368   1.2   itojun 	if (IN6_IS_ADDR_LOOPBACK(&ip6->ip6_src) ||
    369   1.2   itojun 	    IN6_IS_ADDR_LOOPBACK(&ip6->ip6_dst)) {
    370   1.2   itojun 		if (m->m_pkthdr.rcvif->if_flags & IFF_LOOPBACK) {
    371   1.2   itojun 			ours = 1;
    372   1.9   itojun 			deliverifp = m->m_pkthdr.rcvif;
    373   1.2   itojun 			goto hbhcheck;
    374   1.2   itojun 		} else {
    375   1.2   itojun 			ip6stat.ip6s_badscope++;
    376   1.9   itojun 			in6_ifstat_inc(m->m_pkthdr.rcvif, ifs6_in_addrerr);
    377   1.2   itojun 			goto bad;
    378   1.2   itojun 		}
    379   1.2   itojun 	}
    380   1.2   itojun 
    381  1.38   itojun 	/* drop packets if interface ID portion is already filled */
    382  1.38   itojun 	if ((m->m_pkthdr.rcvif->if_flags & IFF_LOOPBACK) == 0) {
    383  1.38   itojun 		if (IN6_IS_SCOPE_LINKLOCAL(&ip6->ip6_src) &&
    384  1.38   itojun 		    ip6->ip6_src.s6_addr16[1]) {
    385  1.38   itojun 			ip6stat.ip6s_badscope++;
    386  1.38   itojun 			goto bad;
    387  1.38   itojun 		}
    388  1.38   itojun 		if (IN6_IS_SCOPE_LINKLOCAL(&ip6->ip6_dst) &&
    389  1.38   itojun 		    ip6->ip6_dst.s6_addr16[1]) {
    390  1.38   itojun 			ip6stat.ip6s_badscope++;
    391  1.38   itojun 			goto bad;
    392  1.38   itojun 		}
    393  1.38   itojun 	}
    394  1.38   itojun 
    395  1.21   itojun #ifndef FAKE_LOOPBACK_IF
    396  1.21   itojun 	if ((m->m_pkthdr.rcvif->if_flags & IFF_LOOPBACK) == 0)
    397  1.21   itojun #else
    398  1.21   itojun 	if (1)
    399  1.21   itojun #endif
    400  1.21   itojun 	{
    401   1.2   itojun 		if (IN6_IS_SCOPE_LINKLOCAL(&ip6->ip6_src))
    402   1.2   itojun 			ip6->ip6_src.s6_addr16[1]
    403   1.2   itojun 				= htons(m->m_pkthdr.rcvif->if_index);
    404   1.2   itojun 		if (IN6_IS_SCOPE_LINKLOCAL(&ip6->ip6_dst))
    405   1.2   itojun 			ip6->ip6_dst.s6_addr16[1]
    406   1.2   itojun 				= htons(m->m_pkthdr.rcvif->if_index);
    407   1.2   itojun 	}
    408   1.2   itojun 
    409   1.9   itojun 	/*
    410  1.21   itojun 	 * XXX we need this since we do not have "goto ours" hack route
    411  1.21   itojun 	 * for some of our ifaddrs on loopback interface.
    412  1.21   itojun 	 * we should correct it by changing in6_ifattach to install
    413  1.21   itojun 	 * "goto ours" hack route.
    414   1.9   itojun 	 */
    415  1.21   itojun 	if ((m->m_pkthdr.rcvif->if_flags & IFF_LOOPBACK) != 0) {
    416  1.21   itojun 		if (IN6_IS_ADDR_LINKLOCAL(&ip6->ip6_dst)) {
    417  1.21   itojun 			ours = 1;
    418  1.21   itojun 			deliverifp = m->m_pkthdr.rcvif;
    419  1.21   itojun 			goto hbhcheck;
    420  1.21   itojun 		}
    421   1.9   itojun 	}
    422   1.9   itojun 
    423   1.2   itojun 	/*
    424   1.2   itojun 	 * Multicast check
    425   1.2   itojun 	 */
    426   1.2   itojun 	if (IN6_IS_ADDR_MULTICAST(&ip6->ip6_dst)) {
    427   1.2   itojun 	  	struct	in6_multi *in6m = 0;
    428   1.9   itojun 
    429   1.9   itojun 		in6_ifstat_inc(m->m_pkthdr.rcvif, ifs6_in_mcast);
    430   1.2   itojun 		/*
    431   1.2   itojun 		 * See if we belong to the destination multicast group on the
    432   1.2   itojun 		 * arrival interface.
    433   1.2   itojun 		 */
    434   1.2   itojun 		IN6_LOOKUP_MULTI(ip6->ip6_dst, m->m_pkthdr.rcvif, in6m);
    435   1.2   itojun 		if (in6m)
    436   1.2   itojun 			ours = 1;
    437   1.2   itojun 		else if (!ip6_mrouter) {
    438   1.2   itojun 			ip6stat.ip6s_notmember++;
    439   1.2   itojun 			ip6stat.ip6s_cantforward++;
    440   1.9   itojun 			in6_ifstat_inc(m->m_pkthdr.rcvif, ifs6_in_discard);
    441   1.2   itojun 			goto bad;
    442   1.2   itojun 		}
    443   1.9   itojun 		deliverifp = m->m_pkthdr.rcvif;
    444   1.2   itojun 		goto hbhcheck;
    445   1.2   itojun 	}
    446   1.2   itojun 
    447   1.2   itojun 	/*
    448   1.2   itojun 	 *  Unicast check
    449   1.2   itojun 	 */
    450  1.22   itojun 	if (ip6_forward_rt.ro_rt != NULL &&
    451  1.22   itojun 	    (ip6_forward_rt.ro_rt->rt_flags & RTF_UP) != 0 &&
    452  1.22   itojun 	    IN6_ARE_ADDR_EQUAL(&ip6->ip6_dst,
    453  1.35   itojun 			       &((struct sockaddr_in6 *)(&ip6_forward_rt.ro_dst))->sin6_addr))
    454  1.25   itojun 		ip6stat.ip6s_forward_cachehit++;
    455  1.22   itojun 	else {
    456  1.35   itojun 		struct sockaddr_in6 *dst6;
    457  1.35   itojun 
    458   1.2   itojun 		if (ip6_forward_rt.ro_rt) {
    459  1.22   itojun 			/* route is down or destination is different */
    460  1.25   itojun 			ip6stat.ip6s_forward_cachemiss++;
    461   1.2   itojun 			RTFREE(ip6_forward_rt.ro_rt);
    462   1.2   itojun 			ip6_forward_rt.ro_rt = 0;
    463   1.2   itojun 		}
    464  1.22   itojun 
    465   1.2   itojun 		bzero(&ip6_forward_rt.ro_dst, sizeof(struct sockaddr_in6));
    466  1.35   itojun 		dst6 = (struct sockaddr_in6 *)&ip6_forward_rt.ro_dst;
    467  1.35   itojun 		dst6->sin6_len = sizeof(struct sockaddr_in6);
    468  1.35   itojun 		dst6->sin6_family = AF_INET6;
    469  1.35   itojun 		dst6->sin6_addr = ip6->ip6_dst;
    470   1.2   itojun 
    471   1.9   itojun 		rtalloc((struct route *)&ip6_forward_rt);
    472   1.2   itojun 	}
    473   1.2   itojun 
    474   1.2   itojun #define rt6_key(r) ((struct sockaddr_in6 *)((r)->rt_nodes->rn_key))
    475   1.2   itojun 
    476   1.2   itojun 	/*
    477   1.2   itojun 	 * Accept the packet if the forwarding interface to the destination
    478   1.2   itojun 	 * according to the routing table is the loopback interface,
    479   1.2   itojun 	 * unless the associated route has a gateway.
    480   1.2   itojun 	 * Note that this approach causes to accept a packet if there is a
    481   1.2   itojun 	 * route to the loopback interface for the destination of the packet.
    482   1.2   itojun 	 * But we think it's even useful in some situations, e.g. when using
    483   1.2   itojun 	 * a special daemon which wants to intercept the packet.
    484   1.2   itojun 	 */
    485   1.2   itojun 	if (ip6_forward_rt.ro_rt &&
    486   1.2   itojun 	    (ip6_forward_rt.ro_rt->rt_flags &
    487   1.2   itojun 	     (RTF_HOST|RTF_GATEWAY)) == RTF_HOST &&
    488   1.2   itojun #if 0
    489   1.2   itojun 	    /*
    490   1.2   itojun 	     * The check below is redundant since the comparison of
    491   1.2   itojun 	     * the destination and the key of the rtentry has
    492   1.2   itojun 	     * already done through looking up the routing table.
    493   1.2   itojun 	     */
    494   1.2   itojun 	    IN6_ARE_ADDR_EQUAL(&ip6->ip6_dst,
    495   1.2   itojun 			       &rt6_key(ip6_forward_rt.ro_rt)->sin6_addr) &&
    496   1.2   itojun #endif
    497   1.9   itojun 	    ip6_forward_rt.ro_rt->rt_ifp->if_type == IFT_LOOP) {
    498   1.2   itojun 		struct in6_ifaddr *ia6 =
    499   1.2   itojun 			(struct in6_ifaddr *)ip6_forward_rt.ro_rt->rt_ifa;
    500   1.2   itojun 		if (ia6->ia6_flags & IN6_IFF_ANYCAST)
    501   1.2   itojun 			m->m_flags |= M_ANYCAST6;
    502  1.24   itojun 		/*
    503  1.24   itojun 		 * packets to a tentative, duplicated, or somehow invalid
    504  1.24   itojun 		 * address must not be accepted.
    505  1.24   itojun 		 */
    506   1.2   itojun 		if (!(ia6->ia6_flags & IN6_IFF_NOTREADY)) {
    507  1.24   itojun 			/* this address is ready */
    508   1.2   itojun 			ours = 1;
    509   1.9   itojun 			deliverifp = ia6->ia_ifp;	/* correct? */
    510   1.2   itojun 			goto hbhcheck;
    511   1.2   itojun 		} else {
    512  1.24   itojun 			/* address is not ready, so discard the packet. */
    513  1.34   itojun 			nd6log((LOG_INFO,
    514  1.27   itojun 			    "ip6_input: packet to an unready address %s->%s\n",
    515  1.24   itojun 			    ip6_sprintf(&ip6->ip6_src),
    516  1.34   itojun 			    ip6_sprintf(&ip6->ip6_dst)));
    517  1.24   itojun 
    518  1.24   itojun 			goto bad;
    519   1.2   itojun 		}
    520   1.2   itojun 	}
    521   1.2   itojun 
    522   1.2   itojun 	/*
    523   1.2   itojun 	 * FAITH(Firewall Aided Internet Translator)
    524   1.2   itojun 	 */
    525   1.2   itojun #if defined(NFAITH) && 0 < NFAITH
    526   1.2   itojun 	if (ip6_keepfaith) {
    527   1.2   itojun 		if (ip6_forward_rt.ro_rt && ip6_forward_rt.ro_rt->rt_ifp
    528   1.2   itojun 		 && ip6_forward_rt.ro_rt->rt_ifp->if_type == IFT_FAITH) {
    529   1.2   itojun 			/* XXX do we need more sanity checks? */
    530   1.2   itojun 			ours = 1;
    531   1.9   itojun 			deliverifp = ip6_forward_rt.ro_rt->rt_ifp; /*faith*/
    532   1.9   itojun 			goto hbhcheck;
    533   1.9   itojun 		}
    534   1.9   itojun 	}
    535   1.9   itojun #endif
    536   1.9   itojun 
    537   1.9   itojun #if 0
    538   1.9   itojun     {
    539   1.9   itojun 	/*
    540   1.9   itojun 	 * Last resort: check in6_ifaddr for incoming interface.
    541   1.9   itojun 	 * The code is here until I update the "goto ours hack" code above
    542   1.9   itojun 	 * working right.
    543   1.9   itojun 	 */
    544   1.9   itojun 	struct ifaddr *ifa;
    545   1.9   itojun 	for (ifa = m->m_pkthdr.rcvif->if_addrlist.tqh_first;
    546   1.9   itojun 	     ifa;
    547   1.9   itojun 	     ifa = ifa->ifa_list.tqe_next) {
    548   1.9   itojun 		if (ifa->ifa_addr == NULL)
    549   1.9   itojun 			continue;	/* just for safety */
    550   1.9   itojun 		if (ifa->ifa_addr->sa_family != AF_INET6)
    551   1.9   itojun 			continue;
    552   1.9   itojun 		if (IN6_ARE_ADDR_EQUAL(IFA_IN6(ifa), &ip6->ip6_dst)) {
    553   1.9   itojun 			ours = 1;
    554   1.9   itojun 			deliverifp = ifa->ifa_ifp;
    555   1.2   itojun 			goto hbhcheck;
    556   1.2   itojun 		}
    557   1.2   itojun 	}
    558   1.9   itojun     }
    559   1.2   itojun #endif
    560   1.2   itojun 
    561   1.2   itojun 	/*
    562   1.2   itojun 	 * Now there is no reason to process the packet if it's not our own
    563   1.2   itojun 	 * and we're not a router.
    564   1.2   itojun 	 */
    565   1.2   itojun 	if (!ip6_forwarding) {
    566   1.2   itojun 		ip6stat.ip6s_cantforward++;
    567   1.9   itojun 		in6_ifstat_inc(m->m_pkthdr.rcvif, ifs6_in_discard);
    568   1.2   itojun 		goto bad;
    569   1.2   itojun 	}
    570   1.2   itojun 
    571   1.2   itojun   hbhcheck:
    572   1.2   itojun 	/*
    573   1.2   itojun 	 * Process Hop-by-Hop options header if it's contained.
    574   1.2   itojun 	 * m may be modified in ip6_hopopts_input().
    575   1.2   itojun 	 * If a JumboPayload option is included, plen will also be modified.
    576   1.2   itojun 	 */
    577   1.2   itojun 	plen = (u_int32_t)ntohs(ip6->ip6_plen);
    578   1.2   itojun 	if (ip6->ip6_nxt == IPPROTO_HOPOPTS) {
    579   1.9   itojun 		struct ip6_hbh *hbh;
    580   1.9   itojun 
    581   1.9   itojun 		if (ip6_hopopts_input(&plen, &rtalert, &m, &off)) {
    582   1.9   itojun #if 0	/*touches NULL pointer*/
    583   1.9   itojun 			in6_ifstat_inc(m->m_pkthdr.rcvif, ifs6_in_discard);
    584   1.9   itojun #endif
    585   1.2   itojun 			return;	/* m have already been freed */
    586   1.9   itojun 		}
    587  1.22   itojun 
    588   1.2   itojun 		/* adjust pointer */
    589   1.2   itojun 		ip6 = mtod(m, struct ip6_hdr *);
    590  1.22   itojun 
    591  1.22   itojun 		/*
    592  1.22   itojun 		 * if the payload length field is 0 and the next header field
    593  1.22   itojun 		 * indicates Hop-by-Hop Options header, then a Jumbo Payload
    594  1.22   itojun 		 * option MUST be included.
    595  1.22   itojun 		 */
    596  1.22   itojun 		if (ip6->ip6_plen == 0 && plen == 0) {
    597  1.22   itojun 			/*
    598  1.22   itojun 			 * Note that if a valid jumbo payload option is
    599  1.22   itojun 			 * contained, ip6_hoptops_input() must set a valid
    600  1.22   itojun 			 * (non-zero) payload length to the variable plen.
    601  1.22   itojun 			 */
    602  1.22   itojun 			ip6stat.ip6s_badoptions++;
    603  1.22   itojun 			in6_ifstat_inc(m->m_pkthdr.rcvif, ifs6_in_discard);
    604  1.22   itojun 			in6_ifstat_inc(m->m_pkthdr.rcvif, ifs6_in_hdrerr);
    605  1.22   itojun 			icmp6_error(m, ICMP6_PARAM_PROB,
    606  1.22   itojun 				    ICMP6_PARAMPROB_HEADER,
    607  1.22   itojun 				    (caddr_t)&ip6->ip6_plen - (caddr_t)ip6);
    608  1.22   itojun 			return;
    609  1.22   itojun 		}
    610   1.9   itojun #ifndef PULLDOWN_TEST
    611   1.9   itojun 		/* ip6_hopopts_input() ensures that mbuf is contiguous */
    612   1.9   itojun 		hbh = (struct ip6_hbh *)(ip6 + 1);
    613   1.9   itojun #else
    614   1.9   itojun 		IP6_EXTHDR_GET(hbh, struct ip6_hbh *, m, sizeof(struct ip6_hdr),
    615   1.9   itojun 			sizeof(struct ip6_hbh));
    616   1.9   itojun 		if (hbh == NULL) {
    617   1.9   itojun 			ip6stat.ip6s_tooshort++;
    618   1.9   itojun 			return;
    619   1.9   itojun 		}
    620   1.9   itojun #endif
    621   1.9   itojun 		nxt = hbh->ip6h_nxt;
    622   1.2   itojun 
    623   1.2   itojun 		/*
    624   1.2   itojun 		 * accept the packet if a router alert option is included
    625   1.2   itojun 		 * and we act as an IPv6 router.
    626   1.2   itojun 		 */
    627   1.5   itojun 		if (rtalert != ~0 && ip6_forwarding)
    628   1.2   itojun 			ours = 1;
    629   1.2   itojun 	} else
    630   1.2   itojun 		nxt = ip6->ip6_nxt;
    631   1.2   itojun 
    632   1.2   itojun 	/*
    633   1.2   itojun 	 * Check that the amount of data in the buffers
    634   1.2   itojun 	 * is as at least much as the IPv6 header would have us expect.
    635   1.2   itojun 	 * Trim mbufs if longer than we expect.
    636   1.2   itojun 	 * Drop packet if shorter than we expect.
    637   1.2   itojun 	 */
    638   1.2   itojun 	if (m->m_pkthdr.len - sizeof(struct ip6_hdr) < plen) {
    639   1.2   itojun 		ip6stat.ip6s_tooshort++;
    640   1.9   itojun 		in6_ifstat_inc(m->m_pkthdr.rcvif, ifs6_in_truncated);
    641   1.2   itojun 		goto bad;
    642   1.2   itojun 	}
    643   1.2   itojun 	if (m->m_pkthdr.len > sizeof(struct ip6_hdr) + plen) {
    644   1.2   itojun 		if (m->m_len == m->m_pkthdr.len) {
    645   1.2   itojun 			m->m_len = sizeof(struct ip6_hdr) + plen;
    646   1.2   itojun 			m->m_pkthdr.len = sizeof(struct ip6_hdr) + plen;
    647   1.2   itojun 		} else
    648   1.2   itojun 			m_adj(m, sizeof(struct ip6_hdr) + plen - m->m_pkthdr.len);
    649   1.2   itojun 	}
    650   1.2   itojun 
    651   1.2   itojun 	/*
    652   1.2   itojun 	 * Forward if desirable.
    653   1.2   itojun 	 */
    654   1.2   itojun 	if (IN6_IS_ADDR_MULTICAST(&ip6->ip6_dst)) {
    655   1.2   itojun 		/*
    656   1.2   itojun 		 * If we are acting as a multicast router, all
    657   1.2   itojun 		 * incoming multicast packets are passed to the
    658   1.2   itojun 		 * kernel-level multicast forwarding function.
    659   1.2   itojun 		 * The packet is returned (relatively) intact; if
    660   1.2   itojun 		 * ip6_mforward() returns a non-zero value, the packet
    661   1.2   itojun 		 * must be discarded, else it may be accepted below.
    662   1.2   itojun 		 */
    663   1.2   itojun 		if (ip6_mrouter && ip6_mforward(ip6, m->m_pkthdr.rcvif, m)) {
    664   1.2   itojun 			ip6stat.ip6s_cantforward++;
    665   1.2   itojun 			m_freem(m);
    666   1.2   itojun 			return;
    667   1.2   itojun 		}
    668   1.2   itojun 		if (!ours) {
    669   1.2   itojun 			m_freem(m);
    670   1.2   itojun 			return;
    671   1.2   itojun 		}
    672  1.22   itojun 	} else if (!ours) {
    673   1.2   itojun 		ip6_forward(m, 0);
    674   1.2   itojun 		return;
    675   1.2   itojun 	}
    676  1.25   itojun 
    677  1.25   itojun 	ip6 = mtod(m, struct ip6_hdr *);
    678  1.25   itojun 
    679  1.25   itojun 	/*
    680  1.25   itojun 	 * Malicious party may be able to use IPv4 mapped addr to confuse
    681  1.25   itojun 	 * tcp/udp stack and bypass security checks (act as if it was from
    682  1.25   itojun 	 * 127.0.0.1 by using IPv6 src ::ffff:127.0.0.1).  Be cautious.
    683  1.25   itojun 	 *
    684  1.25   itojun 	 * For SIIT end node behavior, you may want to disable the check.
    685  1.25   itojun 	 * However, you will  become vulnerable to attacks using IPv4 mapped
    686  1.25   itojun 	 * source.
    687  1.25   itojun 	 */
    688  1.25   itojun 	if (IN6_IS_ADDR_V4MAPPED(&ip6->ip6_src) ||
    689  1.25   itojun 	    IN6_IS_ADDR_V4MAPPED(&ip6->ip6_dst)) {
    690  1.25   itojun 		ip6stat.ip6s_badscope++;
    691  1.25   itojun 		in6_ifstat_inc(m->m_pkthdr.rcvif, ifs6_in_addrerr);
    692  1.25   itojun 		goto bad;
    693  1.25   itojun 	}
    694   1.2   itojun 
    695   1.2   itojun 	/*
    696   1.2   itojun 	 * Tell launch routine the next header
    697   1.2   itojun 	 */
    698  1.12   itojun #ifdef IFA_STATS
    699  1.28   itojun 	if (deliverifp != NULL) {
    700   1.9   itojun 		struct in6_ifaddr *ia6;
    701   1.9   itojun 		ia6 = in6_ifawithifp(deliverifp, &ip6->ip6_dst);
    702   1.9   itojun 		if (ia6)
    703   1.9   itojun 			ia6->ia_ifa.ifa_data.ifad_inbytes += m->m_pkthdr.len;
    704   1.9   itojun 	}
    705   1.9   itojun #endif
    706   1.2   itojun 	ip6stat.ip6s_delivered++;
    707   1.9   itojun 	in6_ifstat_inc(deliverifp, ifs6_in_deliver);
    708   1.2   itojun 	nest = 0;
    709   1.2   itojun 	while (nxt != IPPROTO_DONE) {
    710   1.2   itojun 		if (ip6_hdrnestlimit && (++nest > ip6_hdrnestlimit)) {
    711   1.2   itojun 			ip6stat.ip6s_toomanyhdr++;
    712   1.2   itojun 			goto bad;
    713   1.2   itojun 		}
    714   1.8   itojun 
    715   1.8   itojun 		/*
    716   1.8   itojun 		 * protection against faulty packet - there should be
    717   1.8   itojun 		 * more sanity checks in header chain processing.
    718   1.8   itojun 		 */
    719   1.8   itojun 		if (m->m_pkthdr.len < off) {
    720   1.8   itojun 			ip6stat.ip6s_tooshort++;
    721   1.9   itojun 			in6_ifstat_inc(m->m_pkthdr.rcvif, ifs6_in_truncated);
    722   1.8   itojun 			goto bad;
    723   1.8   itojun 		}
    724   1.8   itojun 
    725  1.37   itojun #ifdef IPSEC
    726  1.37   itojun 		/*
    727  1.37   itojun 		 * enforce IPsec policy checking if we are seeing last header.
    728  1.37   itojun 		 * note that we do not visit this with protocols with pcb layer
    729  1.37   itojun 		 * code - like udp/tcp/raw ip.
    730  1.37   itojun 		 */
    731  1.37   itojun 		if ((inet6sw[ip6_protox[nxt]].pr_flags & PR_LASTHDR) != 0 &&
    732  1.37   itojun 		    ipsec6_in_reject(m, NULL)) {
    733  1.37   itojun 			ipsec6stat.in_polvio++;
    734  1.37   itojun 			goto bad;
    735  1.37   itojun 		}
    736  1.37   itojun #endif
    737  1.37   itojun 
    738   1.2   itojun 		nxt = (*inet6sw[ip6_protox[nxt]].pr_input)(&m, &off, nxt);
    739   1.2   itojun 	}
    740   1.2   itojun 	return;
    741   1.2   itojun  bad:
    742   1.2   itojun 	m_freem(m);
    743   1.2   itojun }
    744   1.2   itojun 
    745   1.2   itojun /*
    746   1.2   itojun  * Hop-by-Hop options header processing. If a valid jumbo payload option is
    747   1.2   itojun  * included, the real payload length will be stored in plenp.
    748   1.2   itojun  */
    749   1.2   itojun static int
    750   1.2   itojun ip6_hopopts_input(plenp, rtalertp, mp, offp)
    751   1.2   itojun 	u_int32_t *plenp;
    752   1.5   itojun 	u_int32_t *rtalertp;	/* XXX: should be stored more smart way */
    753   1.2   itojun 	struct mbuf **mp;
    754   1.2   itojun 	int *offp;
    755   1.2   itojun {
    756  1.35   itojun 	struct mbuf *m = *mp;
    757   1.2   itojun 	int off = *offp, hbhlen;
    758   1.2   itojun 	struct ip6_hbh *hbh;
    759   1.2   itojun 	u_int8_t *opt;
    760   1.2   itojun 
    761   1.2   itojun 	/* validation of the length of the header */
    762   1.9   itojun #ifndef PULLDOWN_TEST
    763   1.2   itojun 	IP6_EXTHDR_CHECK(m, off, sizeof(*hbh), -1);
    764   1.2   itojun 	hbh = (struct ip6_hbh *)(mtod(m, caddr_t) + off);
    765   1.2   itojun 	hbhlen = (hbh->ip6h_len + 1) << 3;
    766   1.2   itojun 
    767   1.2   itojun 	IP6_EXTHDR_CHECK(m, off, hbhlen, -1);
    768   1.2   itojun 	hbh = (struct ip6_hbh *)(mtod(m, caddr_t) + off);
    769   1.9   itojun #else
    770   1.9   itojun 	IP6_EXTHDR_GET(hbh, struct ip6_hbh *, m,
    771   1.9   itojun 		sizeof(struct ip6_hdr), sizeof(struct ip6_hbh));
    772   1.9   itojun 	if (hbh == NULL) {
    773   1.9   itojun 		ip6stat.ip6s_tooshort++;
    774   1.9   itojun 		return -1;
    775   1.9   itojun 	}
    776   1.9   itojun 	hbhlen = (hbh->ip6h_len + 1) << 3;
    777   1.9   itojun 	IP6_EXTHDR_GET(hbh, struct ip6_hbh *, m, sizeof(struct ip6_hdr),
    778   1.9   itojun 		hbhlen);
    779   1.9   itojun 	if (hbh == NULL) {
    780   1.9   itojun 		ip6stat.ip6s_tooshort++;
    781   1.9   itojun 		return -1;
    782   1.9   itojun 	}
    783   1.9   itojun #endif
    784   1.2   itojun 	off += hbhlen;
    785   1.2   itojun 	hbhlen -= sizeof(struct ip6_hbh);
    786   1.2   itojun 	opt = (u_int8_t *)hbh + sizeof(struct ip6_hbh);
    787   1.2   itojun 
    788   1.2   itojun 	if (ip6_process_hopopts(m, (u_int8_t *)hbh + sizeof(struct ip6_hbh),
    789   1.2   itojun 				hbhlen, rtalertp, plenp) < 0)
    790   1.2   itojun 		return(-1);
    791   1.2   itojun 
    792   1.2   itojun 	*offp = off;
    793   1.2   itojun 	*mp = m;
    794   1.2   itojun 	return(0);
    795   1.2   itojun }
    796   1.2   itojun 
    797   1.2   itojun /*
    798   1.2   itojun  * Search header for all Hop-by-hop options and process each option.
    799   1.2   itojun  * This function is separate from ip6_hopopts_input() in order to
    800   1.2   itojun  * handle a case where the sending node itself process its hop-by-hop
    801   1.2   itojun  * options header. In such a case, the function is called from ip6_output().
    802   1.2   itojun  */
    803   1.2   itojun int
    804   1.2   itojun ip6_process_hopopts(m, opthead, hbhlen, rtalertp, plenp)
    805   1.2   itojun 	struct mbuf *m;
    806   1.2   itojun 	u_int8_t *opthead;
    807   1.2   itojun 	int hbhlen;
    808   1.5   itojun 	u_int32_t *rtalertp;
    809   1.2   itojun 	u_int32_t *plenp;
    810   1.2   itojun {
    811   1.2   itojun 	struct ip6_hdr *ip6;
    812   1.2   itojun 	int optlen = 0;
    813   1.2   itojun 	u_int8_t *opt = opthead;
    814   1.2   itojun 	u_int16_t rtalert_val;
    815  1.22   itojun 	u_int32_t jumboplen;
    816   1.2   itojun 
    817   1.2   itojun 	for (; hbhlen > 0; hbhlen -= optlen, opt += optlen) {
    818  1.35   itojun 		switch (*opt) {
    819  1.35   itojun 		case IP6OPT_PAD1:
    820  1.35   itojun 			optlen = 1;
    821  1.35   itojun 			break;
    822  1.35   itojun 		case IP6OPT_PADN:
    823  1.35   itojun 			if (hbhlen < IP6OPT_MINLEN) {
    824  1.35   itojun 				ip6stat.ip6s_toosmall++;
    825  1.35   itojun 				goto bad;
    826  1.35   itojun 			}
    827  1.35   itojun 			optlen = *(opt + 1) + 2;
    828  1.35   itojun 			break;
    829  1.35   itojun 		case IP6OPT_RTALERT:
    830  1.35   itojun 			/* XXX may need check for alignment */
    831  1.35   itojun 			if (hbhlen < IP6OPT_RTALERT_LEN) {
    832  1.35   itojun 				ip6stat.ip6s_toosmall++;
    833  1.35   itojun 				goto bad;
    834  1.35   itojun 			}
    835  1.35   itojun 			if (*(opt + 1) != IP6OPT_RTALERT_LEN - 2) {
    836  1.35   itojun 				 /* XXX: should we discard the packet? */
    837  1.35   itojun 				log(LOG_ERR, "length of router alert opt is inconsitent(%d)",
    838  1.35   itojun 				    *(opt + 1));
    839  1.35   itojun 			}
    840  1.35   itojun 			optlen = IP6OPT_RTALERT_LEN;
    841  1.35   itojun 			bcopy((caddr_t)(opt + 2), (caddr_t)&rtalert_val, 2);
    842  1.35   itojun 			*rtalertp = ntohs(rtalert_val);
    843  1.35   itojun 			break;
    844  1.35   itojun 		case IP6OPT_JUMBO:
    845  1.22   itojun 			/* XXX may need check for alignment */
    846  1.22   itojun 			if (hbhlen < IP6OPT_JUMBO_LEN) {
    847  1.22   itojun 				ip6stat.ip6s_toosmall++;
    848  1.22   itojun 				goto bad;
    849  1.22   itojun 			}
    850  1.35   itojun 			if (*(opt + 1) != IP6OPT_JUMBO_LEN - 2) {
    851  1.35   itojun 				/* XXX: should we discard the packet? */
    852  1.22   itojun 				log(LOG_ERR, "length of jumbopayload opt "
    853  1.27   itojun 				    "is inconsistent(%d)\n",
    854  1.22   itojun 				    *(opt + 1));
    855  1.35   itojun 			}
    856  1.22   itojun 			optlen = IP6OPT_JUMBO_LEN;
    857  1.22   itojun 
    858  1.22   itojun 			/*
    859  1.22   itojun 			 * IPv6 packets that have non 0 payload length
    860  1.35   itojun 			 * must not contain a jumbo payload option.
    861  1.22   itojun 			 */
    862  1.22   itojun 			ip6 = mtod(m, struct ip6_hdr *);
    863  1.22   itojun 			if (ip6->ip6_plen) {
    864  1.22   itojun 				ip6stat.ip6s_badoptions++;
    865  1.22   itojun 				icmp6_error(m, ICMP6_PARAM_PROB,
    866  1.22   itojun 					    ICMP6_PARAMPROB_HEADER,
    867  1.22   itojun 					    sizeof(struct ip6_hdr) +
    868  1.22   itojun 					    sizeof(struct ip6_hbh) +
    869  1.22   itojun 					    opt - opthead);
    870  1.22   itojun 				return(-1);
    871  1.22   itojun 			}
    872   1.2   itojun 
    873  1.22   itojun 			/*
    874  1.22   itojun 			 * We may see jumbolen in unaligned location, so
    875  1.22   itojun 			 * we'd need to perform bcopy().
    876  1.22   itojun 			 */
    877  1.22   itojun 			bcopy(opt + 2, &jumboplen, sizeof(jumboplen));
    878  1.22   itojun 			jumboplen = (u_int32_t)htonl(jumboplen);
    879  1.22   itojun 
    880  1.22   itojun #if 1
    881  1.22   itojun 			/*
    882  1.22   itojun 			 * if there are multiple jumbo payload options,
    883  1.22   itojun 			 * *plenp will be non-zero and the packet will be
    884  1.22   itojun 			 * rejected.
    885  1.22   itojun 			 * the behavior may need some debate in ipngwg -
    886  1.22   itojun 			 * multiple options does not make sense, however,
    887  1.22   itojun 			 * there's no explicit mention in specification.
    888  1.22   itojun 			 */
    889  1.22   itojun 			if (*plenp != 0) {
    890  1.22   itojun 				ip6stat.ip6s_badoptions++;
    891  1.22   itojun 				icmp6_error(m, ICMP6_PARAM_PROB,
    892  1.22   itojun 					    ICMP6_PARAMPROB_HEADER,
    893  1.22   itojun 					    sizeof(struct ip6_hdr) +
    894  1.22   itojun 					    sizeof(struct ip6_hbh) +
    895  1.22   itojun 					    opt + 2 - opthead);
    896  1.22   itojun 				return(-1);
    897  1.22   itojun 			}
    898   1.8   itojun #endif
    899   1.2   itojun 
    900  1.22   itojun 			/*
    901  1.22   itojun 			 * jumbo payload length must be larger than 65535.
    902  1.22   itojun 			 */
    903  1.22   itojun 			if (jumboplen <= IPV6_MAXPACKET) {
    904  1.22   itojun 				ip6stat.ip6s_badoptions++;
    905  1.22   itojun 				icmp6_error(m, ICMP6_PARAM_PROB,
    906  1.22   itojun 					    ICMP6_PARAMPROB_HEADER,
    907  1.22   itojun 					    sizeof(struct ip6_hdr) +
    908  1.22   itojun 					    sizeof(struct ip6_hbh) +
    909  1.22   itojun 					    opt + 2 - opthead);
    910  1.22   itojun 				return(-1);
    911  1.22   itojun 			}
    912  1.22   itojun 			*plenp = jumboplen;
    913  1.22   itojun 
    914  1.22   itojun 			break;
    915  1.35   itojun 		default:		/* unknown option */
    916  1.35   itojun 			if (hbhlen < IP6OPT_MINLEN) {
    917  1.35   itojun 				ip6stat.ip6s_toosmall++;
    918  1.35   itojun 				goto bad;
    919  1.35   itojun 			}
    920  1.35   itojun 			if ((optlen = ip6_unknown_opt(opt, m,
    921  1.35   itojun 						      sizeof(struct ip6_hdr) +
    922  1.35   itojun 						      sizeof(struct ip6_hbh) +
    923  1.35   itojun 						      opt - opthead)) == -1)
    924  1.35   itojun 				return(-1);
    925  1.35   itojun 			optlen += 2;
    926  1.35   itojun 			break;
    927   1.2   itojun 		}
    928   1.2   itojun 	}
    929   1.2   itojun 
    930   1.2   itojun 	return(0);
    931   1.2   itojun 
    932   1.2   itojun   bad:
    933   1.2   itojun 	m_freem(m);
    934   1.2   itojun 	return(-1);
    935   1.2   itojun }
    936   1.2   itojun 
    937   1.2   itojun /*
    938   1.2   itojun  * Unknown option processing.
    939   1.2   itojun  * The third argument `off' is the offset from the IPv6 header to the option,
    940   1.2   itojun  * which is necessary if the IPv6 header the and option header and IPv6 header
    941   1.2   itojun  * is not continuous in order to return an ICMPv6 error.
    942   1.2   itojun  */
    943   1.2   itojun int
    944   1.2   itojun ip6_unknown_opt(optp, m, off)
    945   1.2   itojun 	u_int8_t *optp;
    946   1.2   itojun 	struct mbuf *m;
    947   1.2   itojun 	int off;
    948   1.2   itojun {
    949   1.2   itojun 	struct ip6_hdr *ip6;
    950   1.2   itojun 
    951  1.35   itojun 	switch (IP6OPT_TYPE(*optp)) {
    952  1.35   itojun 	case IP6OPT_TYPE_SKIP: /* ignore the option */
    953  1.35   itojun 		return((int)*(optp + 1));
    954  1.35   itojun 	case IP6OPT_TYPE_DISCARD:	/* silently discard */
    955  1.35   itojun 		m_freem(m);
    956  1.35   itojun 		return(-1);
    957  1.35   itojun 	case IP6OPT_TYPE_FORCEICMP: /* send ICMP even if multicasted */
    958  1.35   itojun 		ip6stat.ip6s_badoptions++;
    959  1.35   itojun 		icmp6_error(m, ICMP6_PARAM_PROB, ICMP6_PARAMPROB_OPTION, off);
    960  1.35   itojun 		return(-1);
    961  1.35   itojun 	case IP6OPT_TYPE_ICMP: /* send ICMP if not multicasted */
    962  1.35   itojun 		ip6stat.ip6s_badoptions++;
    963  1.35   itojun 		ip6 = mtod(m, struct ip6_hdr *);
    964  1.35   itojun 		if (IN6_IS_ADDR_MULTICAST(&ip6->ip6_dst) ||
    965  1.35   itojun 		    (m->m_flags & (M_BCAST|M_MCAST)))
    966  1.35   itojun 			m_freem(m);
    967  1.35   itojun 		else
    968  1.35   itojun 			icmp6_error(m, ICMP6_PARAM_PROB,
    969  1.35   itojun 				    ICMP6_PARAMPROB_OPTION, off);
    970  1.35   itojun 		return(-1);
    971   1.2   itojun 	}
    972   1.2   itojun 
    973   1.2   itojun 	m_freem(m);		/* XXX: NOTREACHED */
    974   1.2   itojun 	return(-1);
    975   1.2   itojun }
    976   1.2   itojun 
    977   1.2   itojun /*
    978   1.9   itojun  * Create the "control" list for this pcb.
    979   1.9   itojun  *
    980   1.9   itojun  * The routine will be called from upper layer handlers like tcp6_input().
    981   1.9   itojun  * Thus the routine assumes that the caller (tcp6_input) have already
    982   1.9   itojun  * called IP6_EXTHDR_CHECK() and all the extension headers are located in the
    983   1.9   itojun  * very first mbuf on the mbuf chain.
    984   1.9   itojun  * We may want to add some infinite loop prevention or sanity checks for safety.
    985   1.9   itojun  * (This applies only when you are using KAME mbuf chain restriction, i.e.
    986   1.9   itojun  * you are using IP6_EXTHDR_CHECK() not m_pulldown())
    987   1.2   itojun  */
    988   1.2   itojun void
    989   1.2   itojun ip6_savecontrol(in6p, mp, ip6, m)
    990  1.35   itojun 	struct in6pcb *in6p;
    991  1.35   itojun 	struct mbuf **mp;
    992  1.35   itojun 	struct ip6_hdr *ip6;
    993  1.35   itojun 	struct mbuf *m;
    994   1.2   itojun {
    995   1.2   itojun 	struct proc *p = curproc;	/* XXX */
    996   1.9   itojun 	int privileged;
    997   1.2   itojun 
    998   1.9   itojun 	privileged = 0;
    999   1.9   itojun 	if (p && !suser(p->p_ucred, &p->p_acflag))
   1000   1.9   itojun 		privileged++;
   1001   1.9   itojun 
   1002   1.9   itojun #ifdef SO_TIMESTAMP
   1003   1.2   itojun 	if (in6p->in6p_socket->so_options & SO_TIMESTAMP) {
   1004   1.2   itojun 		struct timeval tv;
   1005   1.2   itojun 
   1006   1.2   itojun 		microtime(&tv);
   1007   1.2   itojun 		*mp = sbcreatecontrol((caddr_t) &tv, sizeof(tv),
   1008   1.2   itojun 			SCM_TIMESTAMP, SOL_SOCKET);
   1009   1.2   itojun 		if (*mp)
   1010   1.2   itojun 			mp = &(*mp)->m_next;
   1011   1.2   itojun 	}
   1012   1.9   itojun #endif
   1013   1.2   itojun 	if (in6p->in6p_flags & IN6P_RECVDSTADDR) {
   1014   1.2   itojun 		*mp = sbcreatecontrol((caddr_t) &ip6->ip6_dst,
   1015   1.2   itojun 			sizeof(struct in6_addr), IPV6_RECVDSTADDR,
   1016   1.2   itojun 			IPPROTO_IPV6);
   1017   1.2   itojun 		if (*mp)
   1018   1.2   itojun 			mp = &(*mp)->m_next;
   1019   1.2   itojun 	}
   1020   1.2   itojun 
   1021   1.2   itojun #ifdef noyet
   1022   1.2   itojun 	/* options were tossed above */
   1023   1.2   itojun 	if (in6p->in6p_flags & IN6P_RECVOPTS)
   1024   1.2   itojun 		/* broken */
   1025   1.2   itojun 	/* ip6_srcroute doesn't do what we want here, need to fix */
   1026   1.2   itojun 	if (in6p->in6p_flags & IPV6P_RECVRETOPTS)
   1027   1.2   itojun 		/* broken */
   1028   1.2   itojun #endif
   1029   1.2   itojun 
   1030   1.2   itojun 	/* RFC 2292 sec. 5 */
   1031  1.35   itojun 	if ((in6p->in6p_flags & IN6P_PKTINFO) != 0) {
   1032   1.2   itojun 		struct in6_pktinfo pi6;
   1033   1.2   itojun 		bcopy(&ip6->ip6_dst, &pi6.ipi6_addr, sizeof(struct in6_addr));
   1034   1.2   itojun 		if (IN6_IS_SCOPE_LINKLOCAL(&pi6.ipi6_addr))
   1035   1.2   itojun 			pi6.ipi6_addr.s6_addr16[1] = 0;
   1036   1.2   itojun 		pi6.ipi6_ifindex = (m && m->m_pkthdr.rcvif)
   1037   1.2   itojun 					? m->m_pkthdr.rcvif->if_index
   1038   1.2   itojun 					: 0;
   1039   1.2   itojun 		*mp = sbcreatecontrol((caddr_t) &pi6,
   1040   1.2   itojun 			sizeof(struct in6_pktinfo), IPV6_PKTINFO,
   1041   1.2   itojun 			IPPROTO_IPV6);
   1042   1.2   itojun 		if (*mp)
   1043   1.2   itojun 			mp = &(*mp)->m_next;
   1044   1.2   itojun 	}
   1045   1.2   itojun 	if (in6p->in6p_flags & IN6P_HOPLIMIT) {
   1046   1.2   itojun 		int hlim = ip6->ip6_hlim & 0xff;
   1047   1.2   itojun 		*mp = sbcreatecontrol((caddr_t) &hlim,
   1048   1.2   itojun 			sizeof(int), IPV6_HOPLIMIT, IPPROTO_IPV6);
   1049   1.2   itojun 		if (*mp)
   1050   1.2   itojun 			mp = &(*mp)->m_next;
   1051   1.2   itojun 	}
   1052   1.2   itojun 	/* IN6P_NEXTHOP - for outgoing packet only */
   1053   1.2   itojun 
   1054   1.2   itojun 	/*
   1055   1.2   itojun 	 * IPV6_HOPOPTS socket option. We require super-user privilege
   1056   1.2   itojun 	 * for the option, but it might be too strict, since there might
   1057   1.2   itojun 	 * be some hop-by-hop options which can be returned to normal user.
   1058   1.2   itojun 	 * See RFC 2292 section 6.
   1059   1.2   itojun 	 */
   1060  1.35   itojun 	if ((in6p->in6p_flags & IN6P_HOPOPTS) != 0 && privileged) {
   1061   1.2   itojun 		/*
   1062   1.2   itojun 		 * Check if a hop-by-hop options header is contatined in the
   1063   1.2   itojun 		 * received packet, and if so, store the options as ancillary
   1064   1.2   itojun 		 * data. Note that a hop-by-hop options header must be
   1065   1.2   itojun 		 * just after the IPv6 header, which fact is assured through
   1066   1.2   itojun 		 * the IPv6 input processing.
   1067   1.2   itojun 		 */
   1068   1.2   itojun 		struct ip6_hdr *ip6 = mtod(m, struct ip6_hdr *);
   1069   1.2   itojun 		if (ip6->ip6_nxt == IPPROTO_HOPOPTS) {
   1070   1.9   itojun 			struct ip6_hbh *hbh;
   1071   1.9   itojun 			int hbhlen;
   1072   1.9   itojun 
   1073   1.9   itojun #ifndef PULLDOWN_TEST
   1074   1.9   itojun 			hbh = (struct ip6_hbh *)(ip6 + 1);
   1075   1.9   itojun 			hbhlen = (hbh->ip6h_len + 1) << 3;
   1076   1.9   itojun #else
   1077   1.9   itojun 			IP6_EXTHDR_GET(hbh, struct ip6_hbh *, m,
   1078   1.9   itojun 				sizeof(struct ip6_hdr), sizeof(struct ip6_hbh));
   1079   1.9   itojun 			if (hbh == NULL) {
   1080   1.9   itojun 				ip6stat.ip6s_tooshort++;
   1081   1.9   itojun 				return;
   1082   1.9   itojun 			}
   1083   1.9   itojun 			hbhlen = (hbh->ip6h_len + 1) << 3;
   1084   1.9   itojun 			IP6_EXTHDR_GET(hbh, struct ip6_hbh *, m,
   1085   1.9   itojun 				sizeof(struct ip6_hdr), hbhlen);
   1086   1.9   itojun 			if (hbh == NULL) {
   1087   1.9   itojun 				ip6stat.ip6s_tooshort++;
   1088   1.9   itojun 				return;
   1089   1.9   itojun 			}
   1090   1.9   itojun #endif
   1091   1.2   itojun 
   1092   1.2   itojun 			/*
   1093   1.2   itojun 			 * XXX: We copy whole the header even if a jumbo
   1094   1.2   itojun 			 * payload option is included, which option is to
   1095   1.2   itojun 			 * be removed before returning in the RFC 2292.
   1096   1.2   itojun 			 * But it's too painful operation...
   1097   1.2   itojun 			 */
   1098   1.9   itojun 			*mp = sbcreatecontrol((caddr_t)hbh, hbhlen,
   1099   1.2   itojun 					      IPV6_HOPOPTS, IPPROTO_IPV6);
   1100   1.2   itojun 			if (*mp)
   1101   1.2   itojun 				mp = &(*mp)->m_next;
   1102   1.2   itojun 		}
   1103   1.2   itojun 	}
   1104   1.2   itojun 
   1105   1.2   itojun 	/* IPV6_DSTOPTS and IPV6_RTHDR socket options */
   1106   1.2   itojun 	if (in6p->in6p_flags & (IN6P_DSTOPTS | IN6P_RTHDR)) {
   1107   1.2   itojun 		struct ip6_hdr *ip6 = mtod(m, struct ip6_hdr *);
   1108   1.2   itojun 		int nxt = ip6->ip6_nxt, off = sizeof(struct ip6_hdr);;
   1109   1.2   itojun 
   1110   1.2   itojun 		/*
   1111   1.2   itojun 		 * Search for destination options headers or routing
   1112   1.2   itojun 		 * header(s) through the header chain, and stores each
   1113   1.2   itojun 		 * header as ancillary data.
   1114   1.2   itojun 		 * Note that the order of the headers remains in
   1115   1.2   itojun 		 * the chain of ancillary data.
   1116   1.2   itojun 		 */
   1117  1.35   itojun 		while (1) {	/* is explicit loop prevention necessary? */
   1118   1.9   itojun 			struct ip6_ext *ip6e;
   1119   1.9   itojun 			int elen;
   1120   1.9   itojun 
   1121   1.9   itojun #ifndef PULLDOWN_TEST
   1122   1.9   itojun 			ip6e = (struct ip6_ext *)(mtod(m, caddr_t) + off);
   1123   1.9   itojun 			if (nxt == IPPROTO_AH)
   1124   1.9   itojun 				elen = (ip6e->ip6e_len + 2) << 2;
   1125   1.9   itojun 			else
   1126   1.9   itojun 				elen = (ip6e->ip6e_len + 1) << 3;
   1127   1.9   itojun #else
   1128   1.9   itojun 			IP6_EXTHDR_GET(ip6e, struct ip6_ext *, m, off,
   1129   1.9   itojun 				sizeof(struct ip6_ext));
   1130   1.9   itojun 			if (ip6e == NULL) {
   1131   1.9   itojun 				ip6stat.ip6s_tooshort++;
   1132   1.9   itojun 				return;
   1133   1.9   itojun 			}
   1134   1.9   itojun 			if (nxt == IPPROTO_AH)
   1135   1.9   itojun 				elen = (ip6e->ip6e_len + 2) << 2;
   1136   1.9   itojun 			else
   1137   1.9   itojun 				elen = (ip6e->ip6e_len + 1) << 3;
   1138   1.9   itojun 			IP6_EXTHDR_GET(ip6e, struct ip6_ext *, m, off, elen);
   1139   1.9   itojun 			if (ip6e == NULL) {
   1140   1.9   itojun 				ip6stat.ip6s_tooshort++;
   1141   1.9   itojun 				return;
   1142   1.9   itojun 			}
   1143   1.9   itojun #endif
   1144   1.2   itojun 
   1145  1.35   itojun 			switch (nxt) {
   1146  1.35   itojun 		        case IPPROTO_DSTOPTS:
   1147  1.35   itojun 				if (!in6p->in6p_flags & IN6P_DSTOPTS)
   1148  1.35   itojun 					break;
   1149  1.35   itojun 
   1150  1.35   itojun 				/*
   1151  1.35   itojun 				 * We also require super-user privilege for
   1152  1.35   itojun 				 * the option.
   1153  1.35   itojun 				 * See the comments on IN6_HOPOPTS.
   1154  1.35   itojun 				 */
   1155  1.35   itojun 				if (!privileged)
   1156  1.35   itojun 					break;
   1157  1.35   itojun 
   1158  1.35   itojun 				*mp = sbcreatecontrol((caddr_t)ip6e, elen,
   1159  1.35   itojun 						      IPV6_DSTOPTS,
   1160  1.35   itojun 						      IPPROTO_IPV6);
   1161  1.35   itojun 				if (*mp)
   1162  1.35   itojun 					mp = &(*mp)->m_next;
   1163  1.35   itojun 				break;
   1164  1.35   itojun 
   1165  1.35   itojun 			case IPPROTO_ROUTING:
   1166  1.35   itojun 				if (!in6p->in6p_flags & IN6P_RTHDR)
   1167  1.35   itojun 					break;
   1168  1.35   itojun 
   1169  1.35   itojun 				*mp = sbcreatecontrol((caddr_t)ip6e, elen,
   1170  1.35   itojun 						      IPV6_RTHDR,
   1171  1.35   itojun 						      IPPROTO_IPV6);
   1172  1.35   itojun 				if (*mp)
   1173  1.35   itojun 					mp = &(*mp)->m_next;
   1174  1.35   itojun 				break;
   1175  1.35   itojun 
   1176  1.35   itojun 			case IPPROTO_UDP:
   1177  1.35   itojun 			case IPPROTO_TCP:
   1178  1.35   itojun 			case IPPROTO_ICMPV6:
   1179  1.35   itojun 			default:
   1180  1.35   itojun 				/*
   1181  1.35   itojun 				 * stop search if we encounter an upper
   1182  1.35   itojun 				 * layer protocol headers.
   1183  1.35   itojun 				 */
   1184  1.35   itojun 				goto loopend;
   1185  1.35   itojun 
   1186  1.35   itojun 			case IPPROTO_HOPOPTS:
   1187  1.35   itojun 			case IPPROTO_AH: /* is it possible? */
   1188  1.35   itojun 				break;
   1189   1.2   itojun 			}
   1190   1.2   itojun 
   1191   1.2   itojun 			/* proceed with the next header. */
   1192   1.9   itojun 			off += elen;
   1193   1.2   itojun 			nxt = ip6e->ip6e_nxt;
   1194   1.2   itojun 		}
   1195   1.2   itojun 	  loopend:
   1196  1.36      cgd 		;
   1197   1.2   itojun 	}
   1198   1.9   itojun 	if ((in6p->in6p_flags & IN6P_HOPOPTS) && privileged) {
   1199   1.2   itojun 		/* to be done */
   1200   1.2   itojun 	}
   1201   1.9   itojun 	if ((in6p->in6p_flags & IN6P_DSTOPTS) && privileged) {
   1202   1.2   itojun 		/* to be done */
   1203   1.2   itojun 	}
   1204   1.2   itojun 	/* IN6P_RTHDR - to be done */
   1205   1.2   itojun 
   1206   1.2   itojun }
   1207   1.2   itojun 
   1208   1.2   itojun /*
   1209   1.2   itojun  * Get pointer to the previous header followed by the header
   1210   1.2   itojun  * currently processed.
   1211   1.2   itojun  * XXX: This function supposes that
   1212   1.2   itojun  *	M includes all headers,
   1213   1.2   itojun  *	the next header field and the header length field of each header
   1214   1.2   itojun  *	are valid, and
   1215   1.2   itojun  *	the sum of each header length equals to OFF.
   1216   1.2   itojun  * Because of these assumptions, this function must be called very
   1217   1.2   itojun  * carefully. Moreover, it will not be used in the near future when
   1218   1.2   itojun  * we develop `neater' mechanism to process extension headers.
   1219   1.2   itojun  */
   1220   1.2   itojun char *
   1221   1.2   itojun ip6_get_prevhdr(m, off)
   1222   1.2   itojun 	struct mbuf *m;
   1223   1.2   itojun 	int off;
   1224   1.2   itojun {
   1225   1.2   itojun 	struct ip6_hdr *ip6 = mtod(m, struct ip6_hdr *);
   1226   1.2   itojun 
   1227   1.2   itojun 	if (off == sizeof(struct ip6_hdr))
   1228   1.2   itojun 		return(&ip6->ip6_nxt);
   1229   1.2   itojun 	else {
   1230   1.2   itojun 		int len, nxt;
   1231   1.2   itojun 		struct ip6_ext *ip6e = NULL;
   1232   1.2   itojun 
   1233   1.2   itojun 		nxt = ip6->ip6_nxt;
   1234   1.2   itojun 		len = sizeof(struct ip6_hdr);
   1235   1.2   itojun 		while (len < off) {
   1236   1.2   itojun 			ip6e = (struct ip6_ext *)(mtod(m, caddr_t) + len);
   1237   1.2   itojun 
   1238  1.35   itojun 			switch (nxt) {
   1239   1.2   itojun 			case IPPROTO_FRAGMENT:
   1240   1.2   itojun 				len += sizeof(struct ip6_frag);
   1241   1.2   itojun 				break;
   1242   1.2   itojun 			case IPPROTO_AH:
   1243   1.2   itojun 				len += (ip6e->ip6e_len + 2) << 2;
   1244   1.2   itojun 				break;
   1245   1.2   itojun 			default:
   1246   1.2   itojun 				len += (ip6e->ip6e_len + 1) << 3;
   1247   1.2   itojun 				break;
   1248   1.2   itojun 			}
   1249   1.2   itojun 			nxt = ip6e->ip6e_nxt;
   1250   1.2   itojun 		}
   1251   1.2   itojun 		if (ip6e)
   1252   1.2   itojun 			return(&ip6e->ip6e_nxt);
   1253   1.2   itojun 		else
   1254   1.2   itojun 			return NULL;
   1255  1.18   itojun 	}
   1256  1.18   itojun }
   1257  1.18   itojun 
   1258  1.18   itojun /*
   1259  1.18   itojun  * get next header offset.  m will be retained.
   1260  1.18   itojun  */
   1261  1.18   itojun int
   1262  1.18   itojun ip6_nexthdr(m, off, proto, nxtp)
   1263  1.18   itojun 	struct mbuf *m;
   1264  1.18   itojun 	int off;
   1265  1.18   itojun 	int proto;
   1266  1.18   itojun 	int *nxtp;
   1267  1.18   itojun {
   1268  1.18   itojun 	struct ip6_hdr ip6;
   1269  1.18   itojun 	struct ip6_ext ip6e;
   1270  1.18   itojun 	struct ip6_frag fh;
   1271  1.18   itojun 
   1272  1.18   itojun 	/* just in case */
   1273  1.18   itojun 	if (m == NULL)
   1274  1.18   itojun 		panic("ip6_nexthdr: m == NULL");
   1275  1.18   itojun 	if ((m->m_flags & M_PKTHDR) == 0 || m->m_pkthdr.len < off)
   1276  1.18   itojun 		return -1;
   1277  1.18   itojun 
   1278  1.18   itojun 	switch (proto) {
   1279  1.18   itojun 	case IPPROTO_IPV6:
   1280  1.18   itojun 		if (m->m_pkthdr.len < off + sizeof(ip6))
   1281  1.18   itojun 			return -1;
   1282  1.18   itojun 		m_copydata(m, off, sizeof(ip6), (caddr_t)&ip6);
   1283  1.18   itojun 		if (nxtp)
   1284  1.18   itojun 			*nxtp = ip6.ip6_nxt;
   1285  1.18   itojun 		off += sizeof(ip6);
   1286  1.18   itojun 		return off;
   1287  1.18   itojun 
   1288  1.18   itojun 	case IPPROTO_FRAGMENT:
   1289  1.18   itojun 		/*
   1290  1.18   itojun 		 * terminate parsing if it is not the first fragment,
   1291  1.18   itojun 		 * it does not make sense to parse through it.
   1292  1.18   itojun 		 */
   1293  1.18   itojun 		if (m->m_pkthdr.len < off + sizeof(fh))
   1294  1.18   itojun 			return -1;
   1295  1.18   itojun 		m_copydata(m, off, sizeof(fh), (caddr_t)&fh);
   1296  1.18   itojun 		if ((ntohs(fh.ip6f_offlg) & IP6F_OFF_MASK) != 0)
   1297  1.18   itojun 			return -1;
   1298  1.18   itojun 		if (nxtp)
   1299  1.18   itojun 			*nxtp = fh.ip6f_nxt;
   1300  1.18   itojun 		off += sizeof(struct ip6_frag);
   1301  1.18   itojun 		return off;
   1302  1.18   itojun 
   1303  1.18   itojun 	case IPPROTO_AH:
   1304  1.18   itojun 		if (m->m_pkthdr.len < off + sizeof(ip6e))
   1305  1.18   itojun 			return -1;
   1306  1.18   itojun 		m_copydata(m, off, sizeof(ip6e), (caddr_t)&ip6e);
   1307  1.18   itojun 		if (nxtp)
   1308  1.18   itojun 			*nxtp = ip6e.ip6e_nxt;
   1309  1.18   itojun 		off += (ip6e.ip6e_len + 2) << 2;
   1310  1.18   itojun 		return off;
   1311  1.18   itojun 
   1312  1.18   itojun 	case IPPROTO_HOPOPTS:
   1313  1.18   itojun 	case IPPROTO_ROUTING:
   1314  1.18   itojun 	case IPPROTO_DSTOPTS:
   1315  1.18   itojun 		if (m->m_pkthdr.len < off + sizeof(ip6e))
   1316  1.18   itojun 			return -1;
   1317  1.18   itojun 		m_copydata(m, off, sizeof(ip6e), (caddr_t)&ip6e);
   1318  1.18   itojun 		if (nxtp)
   1319  1.18   itojun 			*nxtp = ip6e.ip6e_nxt;
   1320  1.18   itojun 		off += (ip6e.ip6e_len + 1) << 3;
   1321  1.18   itojun 		return off;
   1322  1.18   itojun 
   1323  1.18   itojun 	case IPPROTO_NONE:
   1324  1.18   itojun 	case IPPROTO_ESP:
   1325  1.18   itojun 	case IPPROTO_IPCOMP:
   1326  1.18   itojun 		/* give up */
   1327  1.18   itojun 		return -1;
   1328  1.18   itojun 
   1329  1.18   itojun 	default:
   1330  1.18   itojun 		return -1;
   1331  1.18   itojun 	}
   1332  1.18   itojun 
   1333  1.18   itojun 	return -1;
   1334  1.18   itojun }
   1335  1.18   itojun 
   1336  1.18   itojun /*
   1337  1.18   itojun  * get offset for the last header in the chain.  m will be kept untainted.
   1338  1.18   itojun  */
   1339  1.18   itojun int
   1340  1.18   itojun ip6_lasthdr(m, off, proto, nxtp)
   1341  1.18   itojun 	struct mbuf *m;
   1342  1.18   itojun 	int off;
   1343  1.18   itojun 	int proto;
   1344  1.18   itojun 	int *nxtp;
   1345  1.18   itojun {
   1346  1.18   itojun 	int newoff;
   1347  1.18   itojun 	int nxt;
   1348  1.18   itojun 
   1349  1.18   itojun 	if (!nxtp) {
   1350  1.18   itojun 		nxt = -1;
   1351  1.18   itojun 		nxtp = &nxt;
   1352  1.18   itojun 	}
   1353  1.18   itojun 	while (1) {
   1354  1.18   itojun 		newoff = ip6_nexthdr(m, off, proto, nxtp);
   1355  1.18   itojun 		if (newoff < 0)
   1356  1.18   itojun 			return off;
   1357  1.18   itojun 		else if (newoff < off)
   1358  1.18   itojun 			return -1;	/* invalid */
   1359  1.18   itojun 		else if (newoff == off)
   1360  1.18   itojun 			return newoff;
   1361  1.18   itojun 
   1362  1.18   itojun 		off = newoff;
   1363  1.18   itojun 		proto = *nxtp;
   1364   1.2   itojun 	}
   1365   1.2   itojun }
   1366   1.2   itojun 
   1367   1.2   itojun /*
   1368   1.2   itojun  * System control for IP6
   1369   1.2   itojun  */
   1370   1.2   itojun 
   1371   1.2   itojun u_char	inet6ctlerrmap[PRC_NCMDS] = {
   1372   1.2   itojun 	0,		0,		0,		0,
   1373   1.2   itojun 	0,		EMSGSIZE,	EHOSTDOWN,	EHOSTUNREACH,
   1374   1.2   itojun 	EHOSTUNREACH,	EHOSTUNREACH,	ECONNREFUSED,	ECONNREFUSED,
   1375   1.2   itojun 	EMSGSIZE,	EHOSTUNREACH,	0,		0,
   1376   1.2   itojun 	0,		0,		0,		0,
   1377   1.2   itojun 	ENOPROTOOPT
   1378   1.2   itojun };
   1379   1.2   itojun 
   1380  1.23      mrg #include <uvm/uvm_extern.h>
   1381   1.2   itojun #include <sys/sysctl.h>
   1382   1.2   itojun 
   1383   1.2   itojun int
   1384   1.2   itojun ip6_sysctl(name, namelen, oldp, oldlenp, newp, newlen)
   1385   1.2   itojun 	int *name;
   1386   1.2   itojun 	u_int namelen;
   1387   1.2   itojun 	void *oldp;
   1388   1.2   itojun 	size_t *oldlenp;
   1389   1.2   itojun 	void *newp;
   1390   1.2   itojun 	size_t newlen;
   1391   1.2   itojun {
   1392  1.26   itojun 	int old, error;
   1393  1.26   itojun 
   1394   1.2   itojun 	/* All sysctl names at this level are terminal. */
   1395   1.2   itojun 	if (namelen != 1)
   1396   1.2   itojun 		return ENOTDIR;
   1397   1.2   itojun 
   1398   1.2   itojun 	switch (name[0]) {
   1399   1.2   itojun 
   1400   1.2   itojun 	case IPV6CTL_FORWARDING:
   1401   1.2   itojun 		return sysctl_int(oldp, oldlenp, newp, newlen,
   1402   1.2   itojun 				  &ip6_forwarding);
   1403   1.2   itojun 	case IPV6CTL_SENDREDIRECTS:
   1404   1.2   itojun 		return sysctl_int(oldp, oldlenp, newp, newlen,
   1405   1.2   itojun 				&ip6_sendredirects);
   1406   1.2   itojun 	case IPV6CTL_DEFHLIM:
   1407   1.2   itojun 		return sysctl_int(oldp, oldlenp, newp, newlen, &ip6_defhlim);
   1408   1.2   itojun 	case IPV6CTL_MAXFRAGPACKETS:
   1409   1.2   itojun 		return sysctl_int(oldp, oldlenp, newp, newlen,
   1410   1.2   itojun 				&ip6_maxfragpackets);
   1411   1.2   itojun 	case IPV6CTL_ACCEPT_RTADV:
   1412   1.2   itojun 		return sysctl_int(oldp, oldlenp, newp, newlen,
   1413   1.2   itojun 				&ip6_accept_rtadv);
   1414   1.2   itojun 	case IPV6CTL_KEEPFAITH:
   1415   1.2   itojun 		return sysctl_int(oldp, oldlenp, newp, newlen, &ip6_keepfaith);
   1416   1.2   itojun 	case IPV6CTL_LOG_INTERVAL:
   1417   1.2   itojun 		return sysctl_int(oldp, oldlenp, newp, newlen,
   1418   1.2   itojun 				&ip6_log_interval);
   1419   1.2   itojun 	case IPV6CTL_HDRNESTLIMIT:
   1420   1.2   itojun 		return sysctl_int(oldp, oldlenp, newp, newlen,
   1421   1.2   itojun 				&ip6_hdrnestlimit);
   1422   1.2   itojun 	case IPV6CTL_DAD_COUNT:
   1423   1.2   itojun 		return sysctl_int(oldp, oldlenp, newp, newlen, &ip6_dad_count);
   1424   1.2   itojun 	case IPV6CTL_AUTO_FLOWLABEL:
   1425   1.2   itojun 		return sysctl_int(oldp, oldlenp, newp, newlen,
   1426   1.2   itojun 				&ip6_auto_flowlabel);
   1427   1.2   itojun 	case IPV6CTL_DEFMCASTHLIM:
   1428   1.2   itojun 		return sysctl_int(oldp, oldlenp, newp, newlen,
   1429   1.2   itojun 				&ip6_defmcasthlim);
   1430   1.2   itojun 	case IPV6CTL_GIF_HLIM:
   1431   1.2   itojun 		return sysctl_int(oldp, oldlenp, newp, newlen,
   1432   1.2   itojun 				&ip6_gif_hlim);
   1433   1.2   itojun 	case IPV6CTL_KAME_VERSION:
   1434   1.2   itojun 		return sysctl_rdstring(oldp, oldlenp, newp, __KAME_VERSION);
   1435   1.9   itojun 	case IPV6CTL_USE_DEPRECATED:
   1436   1.9   itojun 		return sysctl_int(oldp, oldlenp, newp, newlen,
   1437   1.9   itojun 				&ip6_use_deprecated);
   1438  1.10   itojun 	case IPV6CTL_RR_PRUNE:
   1439  1.10   itojun 		return sysctl_int(oldp, oldlenp, newp, newlen, &ip6_rr_prune);
   1440  1.12   itojun #ifndef INET6_BINDV6ONLY
   1441  1.11   itojun 	case IPV6CTL_BINDV6ONLY:
   1442  1.11   itojun 		return sysctl_int(oldp, oldlenp, newp, newlen,
   1443  1.11   itojun 				&ip6_bindv6only);
   1444  1.26   itojun #endif
   1445  1.26   itojun 	case IPV6CTL_ANONPORTMIN:
   1446  1.26   itojun 		old = ip6_anonportmin;
   1447  1.26   itojun 		error = sysctl_int(oldp, oldlenp, newp, newlen,
   1448  1.26   itojun 		    &ip6_anonportmin);
   1449  1.26   itojun 		if (ip6_anonportmin >= ip6_anonportmax || ip6_anonportmin < 0 ||
   1450  1.26   itojun 		    ip6_anonportmin > 65535
   1451  1.26   itojun #ifndef IPNOPRIVPORTS
   1452  1.26   itojun 		    || ip6_anonportmin < IPV6PORT_RESERVED
   1453  1.26   itojun #endif
   1454  1.26   itojun 		    ) {
   1455  1.26   itojun 			ip6_anonportmin = old;
   1456  1.26   itojun 			return (EINVAL);
   1457  1.26   itojun 		}
   1458  1.26   itojun 		return (error);
   1459  1.26   itojun 	case IPV6CTL_ANONPORTMAX:
   1460  1.26   itojun 		old = ip6_anonportmax;
   1461  1.26   itojun 		error = sysctl_int(oldp, oldlenp, newp, newlen,
   1462  1.26   itojun 		    &ip6_anonportmax);
   1463  1.26   itojun 		if (ip6_anonportmin >= ip6_anonportmax || ip6_anonportmax < 0 ||
   1464  1.26   itojun 		    ip6_anonportmax > 65535
   1465  1.26   itojun #ifndef IPNOPRIVPORTS
   1466  1.26   itojun 		    || ip6_anonportmax < IPV6PORT_RESERVED
   1467  1.26   itojun #endif
   1468  1.26   itojun 		    ) {
   1469  1.26   itojun 			ip6_anonportmax = old;
   1470  1.26   itojun 			return (EINVAL);
   1471  1.26   itojun 		}
   1472  1.26   itojun 		return (error);
   1473  1.26   itojun #ifndef IPNOPRIVPORTS
   1474  1.26   itojun 	case IPV6CTL_LOWPORTMIN:
   1475  1.26   itojun 		old = ip6_lowportmin;
   1476  1.26   itojun 		error = sysctl_int(oldp, oldlenp, newp, newlen,
   1477  1.26   itojun 		    &ip6_lowportmin);
   1478  1.26   itojun 		if (ip6_lowportmin >= ip6_lowportmax ||
   1479  1.26   itojun 		    ip6_lowportmin > IPV6PORT_RESERVEDMAX ||
   1480  1.26   itojun 		    ip6_lowportmin < IPV6PORT_RESERVEDMIN) {
   1481  1.26   itojun 			ip6_lowportmin = old;
   1482  1.26   itojun 			return (EINVAL);
   1483  1.26   itojun 		}
   1484  1.26   itojun 		return (error);
   1485  1.26   itojun 	case IPV6CTL_LOWPORTMAX:
   1486  1.26   itojun 		old = ip6_lowportmax;
   1487  1.26   itojun 		error = sysctl_int(oldp, oldlenp, newp, newlen,
   1488  1.26   itojun 		    &ip6_lowportmax);
   1489  1.26   itojun 		if (ip6_lowportmin >= ip6_lowportmax ||
   1490  1.26   itojun 		    ip6_lowportmax > IPV6PORT_RESERVEDMAX ||
   1491  1.26   itojun 		    ip6_lowportmax < IPV6PORT_RESERVEDMIN) {
   1492  1.26   itojun 			ip6_lowportmax = old;
   1493  1.26   itojun 			return (EINVAL);
   1494  1.26   itojun 		}
   1495  1.26   itojun 		return (error);
   1496  1.11   itojun #endif
   1497   1.2   itojun 	default:
   1498   1.2   itojun 		return EOPNOTSUPP;
   1499   1.2   itojun 	}
   1500   1.2   itojun 	/* NOTREACHED */
   1501   1.2   itojun }
   1502