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