xref: /freebsd/sys/netinet6/raw_ip6.c (revision 82cd038d51e2fa970be77f4d59c56d3452fedec0)
182cd038dSYoshinobu Inoue /*
282cd038dSYoshinobu Inoue  * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project.
382cd038dSYoshinobu Inoue  * All rights reserved.
482cd038dSYoshinobu Inoue  *
582cd038dSYoshinobu Inoue  * Redistribution and use in source and binary forms, with or without
682cd038dSYoshinobu Inoue  * modification, are permitted provided that the following conditions
782cd038dSYoshinobu Inoue  * are met:
882cd038dSYoshinobu Inoue  * 1. Redistributions of source code must retain the above copyright
982cd038dSYoshinobu Inoue  *    notice, this list of conditions and the following disclaimer.
1082cd038dSYoshinobu Inoue  * 2. Redistributions in binary form must reproduce the above copyright
1182cd038dSYoshinobu Inoue  *    notice, this list of conditions and the following disclaimer in the
1282cd038dSYoshinobu Inoue  *    documentation and/or other materials provided with the distribution.
1382cd038dSYoshinobu Inoue  * 3. Neither the name of the project nor the names of its contributors
1482cd038dSYoshinobu Inoue  *    may be used to endorse or promote products derived from this software
1582cd038dSYoshinobu Inoue  *    without specific prior written permission.
1682cd038dSYoshinobu Inoue  *
1782cd038dSYoshinobu Inoue  * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
1882cd038dSYoshinobu Inoue  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
1982cd038dSYoshinobu Inoue  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
2082cd038dSYoshinobu Inoue  * ARE DISCLAIMED.  IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
2182cd038dSYoshinobu Inoue  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
2282cd038dSYoshinobu Inoue  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
2382cd038dSYoshinobu Inoue  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
2482cd038dSYoshinobu Inoue  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
2582cd038dSYoshinobu Inoue  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
2682cd038dSYoshinobu Inoue  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
2782cd038dSYoshinobu Inoue  * SUCH DAMAGE.
2882cd038dSYoshinobu Inoue  *
2982cd038dSYoshinobu Inoue  * $FreeBSD$
3082cd038dSYoshinobu Inoue  */
3182cd038dSYoshinobu Inoue 
3282cd038dSYoshinobu Inoue /*
3382cd038dSYoshinobu Inoue  * Copyright (c) 1982, 1986, 1988, 1993
3482cd038dSYoshinobu Inoue  *	The Regents of the University of California.  All rights reserved.
3582cd038dSYoshinobu Inoue  *
3682cd038dSYoshinobu Inoue  * Redistribution and use in source and binary forms, with or without
3782cd038dSYoshinobu Inoue  * modification, are permitted provided that the following conditions
3882cd038dSYoshinobu Inoue  * are met:
3982cd038dSYoshinobu Inoue  * 1. Redistributions of source code must retain the above copyright
4082cd038dSYoshinobu Inoue  *    notice, this list of conditions and the following disclaimer.
4182cd038dSYoshinobu Inoue  * 2. Redistributions in binary form must reproduce the above copyright
4282cd038dSYoshinobu Inoue  *    notice, this list of conditions and the following disclaimer in the
4382cd038dSYoshinobu Inoue  *    documentation and/or other materials provided with the distribution.
4482cd038dSYoshinobu Inoue  * 3. All advertising materials mentioning features or use of this software
4582cd038dSYoshinobu Inoue  *    must display the following acknowledgement:
4682cd038dSYoshinobu Inoue  *	This product includes software developed by the University of
4782cd038dSYoshinobu Inoue  *	California, Berkeley and its contributors.
4882cd038dSYoshinobu Inoue  * 4. Neither the name of the University nor the names of its contributors
4982cd038dSYoshinobu Inoue  *    may be used to endorse or promote products derived from this software
5082cd038dSYoshinobu Inoue  *    without specific prior written permission.
5182cd038dSYoshinobu Inoue  *
5282cd038dSYoshinobu Inoue  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
5382cd038dSYoshinobu Inoue  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
5482cd038dSYoshinobu Inoue  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
5582cd038dSYoshinobu Inoue  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
5682cd038dSYoshinobu Inoue  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
5782cd038dSYoshinobu Inoue  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
5882cd038dSYoshinobu Inoue  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
5982cd038dSYoshinobu Inoue  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
6082cd038dSYoshinobu Inoue  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
6182cd038dSYoshinobu Inoue  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
6282cd038dSYoshinobu Inoue  * SUCH DAMAGE.
6382cd038dSYoshinobu Inoue  *
6482cd038dSYoshinobu Inoue  *	@(#)raw_ip.c	8.2 (Berkeley) 1/4/94
6582cd038dSYoshinobu Inoue  */
6682cd038dSYoshinobu Inoue 
6782cd038dSYoshinobu Inoue #include "opt_inet.h"
6882cd038dSYoshinobu Inoue #include "opt_ipsec.h"
6982cd038dSYoshinobu Inoue 
7082cd038dSYoshinobu Inoue #include <stddef.h>
7182cd038dSYoshinobu Inoue 
7282cd038dSYoshinobu Inoue #include <sys/param.h>
7382cd038dSYoshinobu Inoue #include <sys/malloc.h>
7482cd038dSYoshinobu Inoue #include <sys/proc.h>
7582cd038dSYoshinobu Inoue #include <sys/mbuf.h>
7682cd038dSYoshinobu Inoue #include <sys/socket.h>
7782cd038dSYoshinobu Inoue #include <sys/protosw.h>
7882cd038dSYoshinobu Inoue #include <sys/socketvar.h>
7982cd038dSYoshinobu Inoue #include <sys/errno.h>
8082cd038dSYoshinobu Inoue #include <sys/systm.h>
8182cd038dSYoshinobu Inoue 
8282cd038dSYoshinobu Inoue #include <net/if.h>
8382cd038dSYoshinobu Inoue #include <net/route.h>
8482cd038dSYoshinobu Inoue #include <net/if_types.h>
8582cd038dSYoshinobu Inoue 
8682cd038dSYoshinobu Inoue #include <netinet/in.h>
8782cd038dSYoshinobu Inoue #include <netinet/in_var.h>
8882cd038dSYoshinobu Inoue #include <netinet/in_systm.h>
8982cd038dSYoshinobu Inoue #include <netinet6/ip6.h>
9082cd038dSYoshinobu Inoue #include <netinet6/ip6_var.h>
9182cd038dSYoshinobu Inoue #include <netinet6/icmp6.h>
9282cd038dSYoshinobu Inoue #include <netinet/in_pcb.h>
9382cd038dSYoshinobu Inoue #include <netinet6/in6_pcb.h>
9482cd038dSYoshinobu Inoue #include <netinet6/nd6.h>
9582cd038dSYoshinobu Inoue 
9682cd038dSYoshinobu Inoue #ifdef IPSEC
9782cd038dSYoshinobu Inoue #include <netinet6/ipsec.h>
9882cd038dSYoshinobu Inoue #ifdef INET6
9982cd038dSYoshinobu Inoue #include <netinet6/ipsec6.h>
10082cd038dSYoshinobu Inoue #endif /* INET6 */
10182cd038dSYoshinobu Inoue #endif /*IPSEC*/
10282cd038dSYoshinobu Inoue 
10382cd038dSYoshinobu Inoue #include <machine/stdarg.h>
10482cd038dSYoshinobu Inoue 
10582cd038dSYoshinobu Inoue /* #include "faith.h" */
10682cd038dSYoshinobu Inoue 
10782cd038dSYoshinobu Inoue #define	satosin6(sa)	((struct sockaddr_in6 *)(sa))
10882cd038dSYoshinobu Inoue #define	ifatoia6(ifa)	((struct in6_ifaddr *)(ifa))
10982cd038dSYoshinobu Inoue 
11082cd038dSYoshinobu Inoue /*
11182cd038dSYoshinobu Inoue  * Raw interface to IP6 protocol.
11282cd038dSYoshinobu Inoue  */
11382cd038dSYoshinobu Inoue 
11482cd038dSYoshinobu Inoue extern struct	inpcbhead ripcb;
11582cd038dSYoshinobu Inoue extern struct	inpcbinfo ripcbinfo;
11682cd038dSYoshinobu Inoue extern u_long	rip_sendspace;
11782cd038dSYoshinobu Inoue extern u_long	rip_recvspace;
11882cd038dSYoshinobu Inoue 
11982cd038dSYoshinobu Inoue /*
12082cd038dSYoshinobu Inoue  * Setup generic address and protocol structures
12182cd038dSYoshinobu Inoue  * for raw_input routine, then pass them along with
12282cd038dSYoshinobu Inoue  * mbuf chain.
12382cd038dSYoshinobu Inoue  */
12482cd038dSYoshinobu Inoue int
12582cd038dSYoshinobu Inoue rip6_input(mp, offp, proto)
12682cd038dSYoshinobu Inoue 	struct	mbuf **mp;
12782cd038dSYoshinobu Inoue 	int	*offp, proto;
12882cd038dSYoshinobu Inoue {
12982cd038dSYoshinobu Inoue 	struct mbuf *m = *mp;
13082cd038dSYoshinobu Inoue 	register struct ip6_hdr *ip6 = mtod(m, struct ip6_hdr *);
13182cd038dSYoshinobu Inoue 	register struct inpcb *in6p;
13282cd038dSYoshinobu Inoue 	struct inpcb *last = 0;
13382cd038dSYoshinobu Inoue 	struct mbuf *opts = 0;
13482cd038dSYoshinobu Inoue 	struct sockaddr_in6 rip6src;
13582cd038dSYoshinobu Inoue 
13682cd038dSYoshinobu Inoue #if defined(NFAITH) && 0 < NFAITH
13782cd038dSYoshinobu Inoue 	if (m->m_pkthdr.rcvif) {
13882cd038dSYoshinobu Inoue 		if (m->m_pkthdr.rcvif->if_type == IFT_FAITH) {
13982cd038dSYoshinobu Inoue 			/* XXX send icmp6 host/port unreach? */
14082cd038dSYoshinobu Inoue 			m_freem(m);
14182cd038dSYoshinobu Inoue 			return IPPROTO_DONE;
14282cd038dSYoshinobu Inoue 		}
14382cd038dSYoshinobu Inoue 	}
14482cd038dSYoshinobu Inoue #endif
14582cd038dSYoshinobu Inoue 	init_sin6(&rip6src, m); /* general init */
14682cd038dSYoshinobu Inoue 
14782cd038dSYoshinobu Inoue 	LIST_FOREACH(in6p, &ripcb, inp_list) {
14882cd038dSYoshinobu Inoue 		if ((in6p->in6p_vflag & INP_IPV6) == NULL)
14982cd038dSYoshinobu Inoue 			continue;
15082cd038dSYoshinobu Inoue 		if (in6p->in6p_ip6_nxt &&
15182cd038dSYoshinobu Inoue 		    in6p->in6p_ip6_nxt != proto)
15282cd038dSYoshinobu Inoue 			continue;
15382cd038dSYoshinobu Inoue 		if (!IN6_IS_ADDR_UNSPECIFIED(&in6p->in6p_laddr) &&
15482cd038dSYoshinobu Inoue 		    !IN6_ARE_ADDR_EQUAL(&in6p->in6p_laddr, &ip6->ip6_dst))
15582cd038dSYoshinobu Inoue 			continue;
15682cd038dSYoshinobu Inoue 		if (!IN6_IS_ADDR_UNSPECIFIED(&in6p->in6p_faddr) &&
15782cd038dSYoshinobu Inoue 		    !IN6_ARE_ADDR_EQUAL(&in6p->in6p_faddr, &ip6->ip6_src))
15882cd038dSYoshinobu Inoue 			continue;
15982cd038dSYoshinobu Inoue 		if (in6p->in6p_cksum != -1
16082cd038dSYoshinobu Inoue 		    && in6_cksum(m, ip6->ip6_nxt, *offp,
16182cd038dSYoshinobu Inoue 				 m->m_pkthdr.len - *offp)) {
16282cd038dSYoshinobu Inoue 			/* XXX bark something */
16382cd038dSYoshinobu Inoue 			continue;
16482cd038dSYoshinobu Inoue 		}
16582cd038dSYoshinobu Inoue 		if (last) {
16682cd038dSYoshinobu Inoue 			struct mbuf *n = m_copy(m, 0, (int)M_COPYALL);
16782cd038dSYoshinobu Inoue 			if (n) {
16882cd038dSYoshinobu Inoue 				if (last->in6p_flags & IN6P_CONTROLOPTS ||
16982cd038dSYoshinobu Inoue 				    last->in6p_socket->so_options & SO_TIMESTAMP)
17082cd038dSYoshinobu Inoue 					ip6_savecontrol(last, &opts, ip6, n);
17182cd038dSYoshinobu Inoue 				/* strip intermediate headers */
17282cd038dSYoshinobu Inoue 				m_adj(n, *offp);
17382cd038dSYoshinobu Inoue 				if (sbappendaddr(&last->in6p_socket->so_rcv,
17482cd038dSYoshinobu Inoue 						(struct sockaddr *)&rip6src,
17582cd038dSYoshinobu Inoue 						 n, opts) == 0) {
17682cd038dSYoshinobu Inoue 					/* should notify about lost packet */
17782cd038dSYoshinobu Inoue 					m_freem(n);
17882cd038dSYoshinobu Inoue 					if (opts)
17982cd038dSYoshinobu Inoue 						m_freem(opts);
18082cd038dSYoshinobu Inoue 				} else
18182cd038dSYoshinobu Inoue 					sorwakeup(last->in6p_socket);
18282cd038dSYoshinobu Inoue 				opts = NULL;
18382cd038dSYoshinobu Inoue 			}
18482cd038dSYoshinobu Inoue 		}
18582cd038dSYoshinobu Inoue 		last = in6p;
18682cd038dSYoshinobu Inoue 	}
18782cd038dSYoshinobu Inoue 	if (last) {
18882cd038dSYoshinobu Inoue 		if (last->in6p_flags & IN6P_CONTROLOPTS ||
18982cd038dSYoshinobu Inoue 		    last->in6p_socket->so_options & SO_TIMESTAMP)
19082cd038dSYoshinobu Inoue 			ip6_savecontrol(last, &opts, ip6, m);
19182cd038dSYoshinobu Inoue 		/* strip intermediate headers */
19282cd038dSYoshinobu Inoue 		m_adj(m, *offp);
19382cd038dSYoshinobu Inoue 		if (sbappendaddr(&last->in6p_socket->so_rcv,
19482cd038dSYoshinobu Inoue 				(struct sockaddr *)&rip6src, m, opts) == 0) {
19582cd038dSYoshinobu Inoue 			m_freem(m);
19682cd038dSYoshinobu Inoue 			if (opts)
19782cd038dSYoshinobu Inoue 				m_freem(opts);
19882cd038dSYoshinobu Inoue 		} else
19982cd038dSYoshinobu Inoue 			sorwakeup(last->in6p_socket);
20082cd038dSYoshinobu Inoue 	} else {
20182cd038dSYoshinobu Inoue 		if (proto == IPPROTO_NONE)
20282cd038dSYoshinobu Inoue 			m_freem(m);
20382cd038dSYoshinobu Inoue 		else {
20482cd038dSYoshinobu Inoue 			char *prvnxtp = ip6_get_prevhdr(m, *offp); /* XXX */
20582cd038dSYoshinobu Inoue 			icmp6_error(m, ICMP6_PARAM_PROB,
20682cd038dSYoshinobu Inoue 				    ICMP6_PARAMPROB_NEXTHEADER,
20782cd038dSYoshinobu Inoue 				    prvnxtp - mtod(m, char *));
20882cd038dSYoshinobu Inoue 		}
20982cd038dSYoshinobu Inoue 		ip6stat.ip6s_delivered--;
21082cd038dSYoshinobu Inoue 	}
21182cd038dSYoshinobu Inoue 	return IPPROTO_DONE;
21282cd038dSYoshinobu Inoue }
21382cd038dSYoshinobu Inoue 
21482cd038dSYoshinobu Inoue /*
21582cd038dSYoshinobu Inoue  * Generate IPv6 header and pass packet to ip6_output.
21682cd038dSYoshinobu Inoue  * Tack on options user may have setup with control call.
21782cd038dSYoshinobu Inoue  */
21882cd038dSYoshinobu Inoue int
21982cd038dSYoshinobu Inoue #if __STDC__
22082cd038dSYoshinobu Inoue rip6_output(struct mbuf *m, ...)
22182cd038dSYoshinobu Inoue #else
22282cd038dSYoshinobu Inoue rip6_output(m, va_alist)
22382cd038dSYoshinobu Inoue 	struct mbuf *m;
22482cd038dSYoshinobu Inoue 	va_dcl
22582cd038dSYoshinobu Inoue #endif
22682cd038dSYoshinobu Inoue {
22782cd038dSYoshinobu Inoue 	struct socket *so;
22882cd038dSYoshinobu Inoue 	struct sockaddr_in6 *dstsock;
22982cd038dSYoshinobu Inoue 	struct mbuf *control;
23082cd038dSYoshinobu Inoue 	struct in6_addr *dst;
23182cd038dSYoshinobu Inoue 	struct ip6_hdr *ip6;
23282cd038dSYoshinobu Inoue 	struct inpcb *in6p;
23382cd038dSYoshinobu Inoue 	u_int	plen = m->m_pkthdr.len;
23482cd038dSYoshinobu Inoue 	int error = 0;
23582cd038dSYoshinobu Inoue 	struct ip6_pktopts opt, *optp = 0;
23682cd038dSYoshinobu Inoue 	struct ifnet *oifp = NULL;
23782cd038dSYoshinobu Inoue 	int type = 0, code = 0;		/* for ICMPv6 output statistics only */
23882cd038dSYoshinobu Inoue 	int priv = 0;
23982cd038dSYoshinobu Inoue 	va_list ap;
24082cd038dSYoshinobu Inoue 
24182cd038dSYoshinobu Inoue 	va_start(ap, m);
24282cd038dSYoshinobu Inoue 	so = va_arg(ap, struct socket *);
24382cd038dSYoshinobu Inoue 	dstsock = va_arg(ap, struct sockaddr_in6 *);
24482cd038dSYoshinobu Inoue 	control = va_arg(ap, struct mbuf *);
24582cd038dSYoshinobu Inoue 	va_end(ap);
24682cd038dSYoshinobu Inoue 
24782cd038dSYoshinobu Inoue 	in6p = sotoin6pcb(so);
24882cd038dSYoshinobu Inoue 
24982cd038dSYoshinobu Inoue 	priv = 0;
25082cd038dSYoshinobu Inoue 	if (so->so_cred->cr_uid == 0)
25182cd038dSYoshinobu Inoue 		priv = 1;
25282cd038dSYoshinobu Inoue 	dst = &dstsock->sin6_addr;
25382cd038dSYoshinobu Inoue 	if (control) {
25482cd038dSYoshinobu Inoue 		if ((error = ip6_setpktoptions(control, &opt, priv)) != 0)
25582cd038dSYoshinobu Inoue 			goto bad;
25682cd038dSYoshinobu Inoue 		optp = &opt;
25782cd038dSYoshinobu Inoue 	} else
25882cd038dSYoshinobu Inoue 		optp = in6p->in6p_outputopts;
25982cd038dSYoshinobu Inoue 
26082cd038dSYoshinobu Inoue 	/*
26182cd038dSYoshinobu Inoue 	 * For an ICMPv6 packet, we should know its type and code
26282cd038dSYoshinobu Inoue 	 * to update statistics.
26382cd038dSYoshinobu Inoue 	 */
26482cd038dSYoshinobu Inoue 	if (so->so_proto->pr_protocol == IPPROTO_ICMPV6) {
26582cd038dSYoshinobu Inoue 		struct icmp6_hdr *icmp6;
26682cd038dSYoshinobu Inoue 		if (m->m_len < sizeof(struct icmp6_hdr) &&
26782cd038dSYoshinobu Inoue 		    (m = m_pullup(m, sizeof(struct icmp6_hdr))) == NULL) {
26882cd038dSYoshinobu Inoue 			error = ENOBUFS;
26982cd038dSYoshinobu Inoue 			goto bad;
27082cd038dSYoshinobu Inoue 		}
27182cd038dSYoshinobu Inoue 		icmp6 = mtod(m, struct icmp6_hdr *);
27282cd038dSYoshinobu Inoue 		type = icmp6->icmp6_type;
27382cd038dSYoshinobu Inoue 		code = icmp6->icmp6_code;
27482cd038dSYoshinobu Inoue 	}
27582cd038dSYoshinobu Inoue 
27682cd038dSYoshinobu Inoue 	M_PREPEND(m, sizeof(*ip6), M_WAIT);
27782cd038dSYoshinobu Inoue 	ip6 = mtod(m, struct ip6_hdr *);
27882cd038dSYoshinobu Inoue 
27982cd038dSYoshinobu Inoue 	/*
28082cd038dSYoshinobu Inoue 	 * Next header might not be ICMP6 but use its pseudo header anyway.
28182cd038dSYoshinobu Inoue 	 */
28282cd038dSYoshinobu Inoue 	ip6->ip6_dst = *dst;
28382cd038dSYoshinobu Inoue 
28482cd038dSYoshinobu Inoue 	/*
28582cd038dSYoshinobu Inoue 	 * If the scope of the destination is link-local, embed the interface
28682cd038dSYoshinobu Inoue 	 * index in the address.
28782cd038dSYoshinobu Inoue 	 *
28882cd038dSYoshinobu Inoue 	 * XXX advanced-api value overrides sin6_scope_id
28982cd038dSYoshinobu Inoue 	 */
29082cd038dSYoshinobu Inoue 	if (IN6_IS_SCOPE_LINKLOCAL(&ip6->ip6_dst)) {
29182cd038dSYoshinobu Inoue 		struct in6_pktinfo *pi;
29282cd038dSYoshinobu Inoue 
29382cd038dSYoshinobu Inoue 		/*
29482cd038dSYoshinobu Inoue 		 * XXX Boundary check is assumed to be already done in
29582cd038dSYoshinobu Inoue 		 * ip6_setpktoptions().
29682cd038dSYoshinobu Inoue 		 */
29782cd038dSYoshinobu Inoue 		if (optp && (pi = optp->ip6po_pktinfo) && pi->ipi6_ifindex) {
29882cd038dSYoshinobu Inoue 			ip6->ip6_dst.s6_addr16[1] = htons(pi->ipi6_ifindex);
29982cd038dSYoshinobu Inoue 			oifp = ifindex2ifnet[pi->ipi6_ifindex];
30082cd038dSYoshinobu Inoue 		} else if (IN6_IS_ADDR_MULTICAST(&ip6->ip6_dst) &&
30182cd038dSYoshinobu Inoue 			 in6p->in6p_moptions &&
30282cd038dSYoshinobu Inoue 			 in6p->in6p_moptions->im6o_multicast_ifp) {
30382cd038dSYoshinobu Inoue 			oifp = in6p->in6p_moptions->im6o_multicast_ifp;
30482cd038dSYoshinobu Inoue 			ip6->ip6_dst.s6_addr16[1] = htons(oifp->if_index);
30582cd038dSYoshinobu Inoue 		} else if (dstsock->sin6_scope_id) {
30682cd038dSYoshinobu Inoue 			/* boundary check */
30782cd038dSYoshinobu Inoue 			if (dstsock->sin6_scope_id < 0
30882cd038dSYoshinobu Inoue 			 || if_index < dstsock->sin6_scope_id) {
30982cd038dSYoshinobu Inoue 				error = ENXIO;  /* XXX EINVAL? */
31082cd038dSYoshinobu Inoue 				goto bad;
31182cd038dSYoshinobu Inoue 			}
31282cd038dSYoshinobu Inoue 			ip6->ip6_dst.s6_addr16[1]
31382cd038dSYoshinobu Inoue 				= htons(dstsock->sin6_scope_id & 0xffff);/*XXX*/
31482cd038dSYoshinobu Inoue 		}
31582cd038dSYoshinobu Inoue 	}
31682cd038dSYoshinobu Inoue 
31782cd038dSYoshinobu Inoue 	/*
31882cd038dSYoshinobu Inoue 	 * Source address selection.
31982cd038dSYoshinobu Inoue 	 */
32082cd038dSYoshinobu Inoue 	{
32182cd038dSYoshinobu Inoue 		struct in6_addr *in6a;
32282cd038dSYoshinobu Inoue 
32382cd038dSYoshinobu Inoue 		if ((in6a = in6_selectsrc(dstsock, optp,
32482cd038dSYoshinobu Inoue 					  in6p->in6p_moptions,
32582cd038dSYoshinobu Inoue 					  &in6p->in6p_route,
32682cd038dSYoshinobu Inoue 					  &in6p->in6p_laddr,
32782cd038dSYoshinobu Inoue 					  &error)) == 0) {
32882cd038dSYoshinobu Inoue 			if (error == 0)
32982cd038dSYoshinobu Inoue 				error = EADDRNOTAVAIL;
33082cd038dSYoshinobu Inoue 			goto bad;
33182cd038dSYoshinobu Inoue 		}
33282cd038dSYoshinobu Inoue 		ip6->ip6_src = *in6a;
33382cd038dSYoshinobu Inoue 		if (in6p->in6p_route.ro_rt)
33482cd038dSYoshinobu Inoue 			oifp = ifindex2ifnet[in6p->in6p_route.ro_rt->rt_ifp->if_index];
33582cd038dSYoshinobu Inoue 	}
33682cd038dSYoshinobu Inoue 
33782cd038dSYoshinobu Inoue 	ip6->ip6_flow = in6p->in6p_flowinfo & IPV6_FLOWINFO_MASK;
33882cd038dSYoshinobu Inoue 	ip6->ip6_vfc  = IPV6_VERSION;
33982cd038dSYoshinobu Inoue 	/* ip6_plen will be filled in ip6_output, so not fill it here. */
34082cd038dSYoshinobu Inoue 	ip6->ip6_nxt = in6p->in6p_ip6_nxt;
34182cd038dSYoshinobu Inoue 	ip6->ip6_hlim = in6_selecthlim(in6p, oifp);
34282cd038dSYoshinobu Inoue 
34382cd038dSYoshinobu Inoue 	if (so->so_proto->pr_protocol == IPPROTO_ICMPV6 ||
34482cd038dSYoshinobu Inoue 	    in6p->in6p_cksum != -1) {
34582cd038dSYoshinobu Inoue 		struct mbuf *n;
34682cd038dSYoshinobu Inoue 		int off;
34782cd038dSYoshinobu Inoue 		u_int16_t *p;
34882cd038dSYoshinobu Inoue 
34982cd038dSYoshinobu Inoue #define	offsetof(type, member)	((size_t)(&((type *)0)->member)) /* XXX */
35082cd038dSYoshinobu Inoue 
35182cd038dSYoshinobu Inoue 		/* compute checksum */
35282cd038dSYoshinobu Inoue 		if (so->so_proto->pr_protocol == IPPROTO_ICMPV6)
35382cd038dSYoshinobu Inoue 			off = offsetof(struct icmp6_hdr, icmp6_cksum);
35482cd038dSYoshinobu Inoue 		else
35582cd038dSYoshinobu Inoue 			off = in6p->in6p_cksum;
35682cd038dSYoshinobu Inoue 		if (plen < off + 1) {
35782cd038dSYoshinobu Inoue 			error = EINVAL;
35882cd038dSYoshinobu Inoue 			goto bad;
35982cd038dSYoshinobu Inoue 		}
36082cd038dSYoshinobu Inoue 		off += sizeof(struct ip6_hdr);
36182cd038dSYoshinobu Inoue 
36282cd038dSYoshinobu Inoue 		n = m;
36382cd038dSYoshinobu Inoue 		while (n && n->m_len <= off) {
36482cd038dSYoshinobu Inoue 			off -= n->m_len;
36582cd038dSYoshinobu Inoue 			n = n->m_next;
36682cd038dSYoshinobu Inoue 		}
36782cd038dSYoshinobu Inoue 		if (!n)
36882cd038dSYoshinobu Inoue 			goto bad;
36982cd038dSYoshinobu Inoue 		p = (u_int16_t *)(mtod(n, caddr_t) + off);
37082cd038dSYoshinobu Inoue 		*p = 0;
37182cd038dSYoshinobu Inoue 		*p = in6_cksum(m, ip6->ip6_nxt, sizeof(*ip6), plen);
37282cd038dSYoshinobu Inoue 	}
37382cd038dSYoshinobu Inoue 
37482cd038dSYoshinobu Inoue #ifdef IPSEC
37582cd038dSYoshinobu Inoue 	m->m_pkthdr.rcvif = (struct ifnet *)so;
37682cd038dSYoshinobu Inoue #endif /*IPSEC*/
37782cd038dSYoshinobu Inoue 
37882cd038dSYoshinobu Inoue 	error = ip6_output(m, optp, &in6p->in6p_route, 0, in6p->in6p_moptions,
37982cd038dSYoshinobu Inoue 			   &oifp);
38082cd038dSYoshinobu Inoue 	if (so->so_proto->pr_protocol == IPPROTO_ICMPV6) {
38182cd038dSYoshinobu Inoue 		if (oifp)
38282cd038dSYoshinobu Inoue 			icmp6_ifoutstat_inc(oifp, type, code);
38382cd038dSYoshinobu Inoue 		icmp6stat.icp6s_outhist[type]++;
38482cd038dSYoshinobu Inoue 	}
38582cd038dSYoshinobu Inoue 
38682cd038dSYoshinobu Inoue 	goto freectl;
38782cd038dSYoshinobu Inoue 
38882cd038dSYoshinobu Inoue  bad:
38982cd038dSYoshinobu Inoue 	if (m)
39082cd038dSYoshinobu Inoue 		m_freem(m);
39182cd038dSYoshinobu Inoue 
39282cd038dSYoshinobu Inoue  freectl:
39382cd038dSYoshinobu Inoue 	if (optp == &opt && optp->ip6po_rthdr && optp->ip6po_route.ro_rt)
39482cd038dSYoshinobu Inoue 		RTFREE(optp->ip6po_route.ro_rt);
39582cd038dSYoshinobu Inoue 	if (control)
39682cd038dSYoshinobu Inoue 		m_freem(control);
39782cd038dSYoshinobu Inoue 	return(error);
39882cd038dSYoshinobu Inoue }
39982cd038dSYoshinobu Inoue 
40082cd038dSYoshinobu Inoue /*
40182cd038dSYoshinobu Inoue  * Raw IPv6 socket option processing.
40282cd038dSYoshinobu Inoue  */
40382cd038dSYoshinobu Inoue int
40482cd038dSYoshinobu Inoue rip6_ctloutput(so, sopt)
40582cd038dSYoshinobu Inoue 	struct socket *so;
40682cd038dSYoshinobu Inoue 	struct sockopt *sopt;
40782cd038dSYoshinobu Inoue {
40882cd038dSYoshinobu Inoue 	int error;
40982cd038dSYoshinobu Inoue 
41082cd038dSYoshinobu Inoue 	if (sopt->sopt_level == IPPROTO_ICMPV6)
41182cd038dSYoshinobu Inoue 		/*
41282cd038dSYoshinobu Inoue 		 * XXX: is it better to call icmp6_ctloutput() directly
41382cd038dSYoshinobu Inoue 		 * from protosw?
41482cd038dSYoshinobu Inoue 		 */
41582cd038dSYoshinobu Inoue 		return(icmp6_ctloutput(so, sopt));
41682cd038dSYoshinobu Inoue 	else if (sopt->sopt_level != IPPROTO_IPV6)
41782cd038dSYoshinobu Inoue 		return (EINVAL);
41882cd038dSYoshinobu Inoue 
41982cd038dSYoshinobu Inoue 	error = 0;
42082cd038dSYoshinobu Inoue 
42182cd038dSYoshinobu Inoue 	switch (sopt->sopt_dir) {
42282cd038dSYoshinobu Inoue 	case SOPT_GET:
42382cd038dSYoshinobu Inoue 		switch (sopt->sopt_name) {
42482cd038dSYoshinobu Inoue 		default:
42582cd038dSYoshinobu Inoue 			error = ip6_ctloutput(so, sopt);
42682cd038dSYoshinobu Inoue 			break;
42782cd038dSYoshinobu Inoue 		}
42882cd038dSYoshinobu Inoue 		break;
42982cd038dSYoshinobu Inoue 
43082cd038dSYoshinobu Inoue 	case SOPT_SET:
43182cd038dSYoshinobu Inoue 		switch (sopt->sopt_name) {
43282cd038dSYoshinobu Inoue 		default:
43382cd038dSYoshinobu Inoue 			error = ip6_ctloutput(so, sopt);
43482cd038dSYoshinobu Inoue 			break;
43582cd038dSYoshinobu Inoue 		}
43682cd038dSYoshinobu Inoue 		break;
43782cd038dSYoshinobu Inoue 	}
43882cd038dSYoshinobu Inoue 
43982cd038dSYoshinobu Inoue 	return (error);
44082cd038dSYoshinobu Inoue }
44182cd038dSYoshinobu Inoue 
44282cd038dSYoshinobu Inoue static int
44382cd038dSYoshinobu Inoue rip6_attach(struct socket *so, int proto, struct proc *p)
44482cd038dSYoshinobu Inoue {
44582cd038dSYoshinobu Inoue 	struct inpcb *inp;
44682cd038dSYoshinobu Inoue 	int error, s;
44782cd038dSYoshinobu Inoue 
44882cd038dSYoshinobu Inoue 	inp = sotoinpcb(so);
44982cd038dSYoshinobu Inoue 	if (inp)
45082cd038dSYoshinobu Inoue 		panic("rip6_attach");
45182cd038dSYoshinobu Inoue 	if (p && (error = suser(p)) != 0)
45282cd038dSYoshinobu Inoue 		return error;
45382cd038dSYoshinobu Inoue 
45482cd038dSYoshinobu Inoue 	if (so->so_snd.sb_hiwat == 0 || so->so_rcv.sb_hiwat == 0) {
45582cd038dSYoshinobu Inoue 		error = soreserve(so, rip_sendspace, rip_recvspace);
45682cd038dSYoshinobu Inoue 		if (error)
45782cd038dSYoshinobu Inoue 			return error;
45882cd038dSYoshinobu Inoue 	}
45982cd038dSYoshinobu Inoue 	s = splnet();
46082cd038dSYoshinobu Inoue 	error = in_pcballoc(so, &ripcbinfo, p);
46182cd038dSYoshinobu Inoue 	splx(s);
46282cd038dSYoshinobu Inoue 	if (error)
46382cd038dSYoshinobu Inoue 		return error;
46482cd038dSYoshinobu Inoue 	inp = (struct inpcb *)so->so_pcb;
46582cd038dSYoshinobu Inoue 	inp->inp_vflag |= INP_IPV6;
46682cd038dSYoshinobu Inoue 	inp->in6p_ip6_nxt = (long)proto;
46782cd038dSYoshinobu Inoue 	inp->in6p_hops = -1;	/* use kernel default */
46882cd038dSYoshinobu Inoue 	inp->in6p_cksum = -1;
46982cd038dSYoshinobu Inoue #ifdef IPSEC
47082cd038dSYoshinobu Inoue 	error = ipsec_init_policy(so, &inp->in6p_sp);
47182cd038dSYoshinobu Inoue 	if (error != 0) {
47282cd038dSYoshinobu Inoue 		in6_pcbdetach(inp);
47382cd038dSYoshinobu Inoue 		return (error);
47482cd038dSYoshinobu Inoue 	}
47582cd038dSYoshinobu Inoue #endif /*IPSEC*/
47682cd038dSYoshinobu Inoue 	MALLOC(inp->in6p_icmp6filt, struct icmp6_filter *,
47782cd038dSYoshinobu Inoue 	       sizeof(struct icmp6_filter), M_PCB, M_NOWAIT);
47882cd038dSYoshinobu Inoue 	ICMP6_FILTER_SETPASSALL(inp->in6p_icmp6filt);
47982cd038dSYoshinobu Inoue 	return 0;
48082cd038dSYoshinobu Inoue }
48182cd038dSYoshinobu Inoue 
48282cd038dSYoshinobu Inoue static int
48382cd038dSYoshinobu Inoue rip6_detach(struct socket *so)
48482cd038dSYoshinobu Inoue {
48582cd038dSYoshinobu Inoue 	struct inpcb *inp;
48682cd038dSYoshinobu Inoue 
48782cd038dSYoshinobu Inoue 	inp = sotoinpcb(so);
48882cd038dSYoshinobu Inoue 	if (inp == 0)
48982cd038dSYoshinobu Inoue 		panic("rip6_detach");
49082cd038dSYoshinobu Inoue 	/* xxx: RSVP */
49182cd038dSYoshinobu Inoue 	if (inp->in6p_icmp6filt) {
49282cd038dSYoshinobu Inoue 		FREE(inp->in6p_icmp6filt, M_PCB);
49382cd038dSYoshinobu Inoue 		inp->in6p_icmp6filt = NULL;
49482cd038dSYoshinobu Inoue 	}
49582cd038dSYoshinobu Inoue 	in6_pcbdetach(inp);
49682cd038dSYoshinobu Inoue 	return 0;
49782cd038dSYoshinobu Inoue }
49882cd038dSYoshinobu Inoue 
49982cd038dSYoshinobu Inoue static int
50082cd038dSYoshinobu Inoue rip6_abort(struct socket *so)
50182cd038dSYoshinobu Inoue {
50282cd038dSYoshinobu Inoue 	soisdisconnected(so);
50382cd038dSYoshinobu Inoue 	return rip6_detach(so);
50482cd038dSYoshinobu Inoue }
50582cd038dSYoshinobu Inoue 
50682cd038dSYoshinobu Inoue static int
50782cd038dSYoshinobu Inoue rip6_disconnect(struct socket *so)
50882cd038dSYoshinobu Inoue {
50982cd038dSYoshinobu Inoue 	struct inpcb *inp = sotoinpcb(so);
51082cd038dSYoshinobu Inoue 
51182cd038dSYoshinobu Inoue 	if ((so->so_state & SS_ISCONNECTED) == 0)
51282cd038dSYoshinobu Inoue 		return ENOTCONN;
51382cd038dSYoshinobu Inoue 	inp->in6p_faddr = in6addr_any;
51482cd038dSYoshinobu Inoue 	return rip6_abort(so);
51582cd038dSYoshinobu Inoue }
51682cd038dSYoshinobu Inoue 
51782cd038dSYoshinobu Inoue static int
51882cd038dSYoshinobu Inoue rip6_bind(struct socket *so, struct sockaddr *nam, struct proc *p)
51982cd038dSYoshinobu Inoue {
52082cd038dSYoshinobu Inoue 	struct inpcb *inp = sotoinpcb(so);
52182cd038dSYoshinobu Inoue 	struct sockaddr_in6 *addr = (struct sockaddr_in6 *)nam;
52282cd038dSYoshinobu Inoue 	struct ifaddr *ia = NULL;
52382cd038dSYoshinobu Inoue 
52482cd038dSYoshinobu Inoue 	if (nam->sa_len != sizeof(*addr))
52582cd038dSYoshinobu Inoue 		return EINVAL;
52682cd038dSYoshinobu Inoue 
52782cd038dSYoshinobu Inoue 	if (TAILQ_EMPTY(&ifnet) || addr->sin6_family != AF_INET6)
52882cd038dSYoshinobu Inoue 		return EADDRNOTAVAIL;
52982cd038dSYoshinobu Inoue 	if (!IN6_IS_ADDR_UNSPECIFIED(&addr->sin6_addr) &&
53082cd038dSYoshinobu Inoue 	    (ia = ifa_ifwithaddr((struct sockaddr *)addr)) == 0)
53182cd038dSYoshinobu Inoue 		return EADDRNOTAVAIL;
53282cd038dSYoshinobu Inoue 	if (ia &&
53382cd038dSYoshinobu Inoue 	    ((struct in6_ifaddr *)ia)->ia6_flags &
53482cd038dSYoshinobu Inoue 	    (IN6_IFF_ANYCAST|IN6_IFF_NOTREADY|
53582cd038dSYoshinobu Inoue 	     IN6_IFF_DETACHED|IN6_IFF_DEPRECATED)) {
53682cd038dSYoshinobu Inoue 		return(EADDRNOTAVAIL);
53782cd038dSYoshinobu Inoue 	}
53882cd038dSYoshinobu Inoue 	inp->in6p_laddr = addr->sin6_addr;
53982cd038dSYoshinobu Inoue 	return 0;
54082cd038dSYoshinobu Inoue }
54182cd038dSYoshinobu Inoue 
54282cd038dSYoshinobu Inoue static int
54382cd038dSYoshinobu Inoue rip6_connect(struct socket *so, struct sockaddr *nam, struct proc *p)
54482cd038dSYoshinobu Inoue {
54582cd038dSYoshinobu Inoue 	struct inpcb *inp = sotoinpcb(so);
54682cd038dSYoshinobu Inoue 	struct sockaddr_in6 *addr = (struct sockaddr_in6 *)nam;
54782cd038dSYoshinobu Inoue 	struct in6_addr *in6a = NULL;
54882cd038dSYoshinobu Inoue 	int error = 0;
54982cd038dSYoshinobu Inoue 
55082cd038dSYoshinobu Inoue 	if (nam->sa_len != sizeof(*addr))
55182cd038dSYoshinobu Inoue 		return EINVAL;
55282cd038dSYoshinobu Inoue 	if (TAILQ_EMPTY(&ifnet))
55382cd038dSYoshinobu Inoue 		return EADDRNOTAVAIL;
55482cd038dSYoshinobu Inoue 	if (addr->sin6_family != AF_INET6)
55582cd038dSYoshinobu Inoue 		return EAFNOSUPPORT;
55682cd038dSYoshinobu Inoue 
55782cd038dSYoshinobu Inoue 	/* Source address selection. XXX: need pcblookup? */
55882cd038dSYoshinobu Inoue 	in6a = in6_selectsrc(addr, inp->in6p_outputopts,
55982cd038dSYoshinobu Inoue 			     inp->in6p_moptions, &inp->in6p_route,
56082cd038dSYoshinobu Inoue 			     &inp->in6p_laddr, &error);
56182cd038dSYoshinobu Inoue 	if (in6a == NULL)
56282cd038dSYoshinobu Inoue 		return (error ? error : EADDRNOTAVAIL);
56382cd038dSYoshinobu Inoue 	inp->in6p_laddr = *in6a;
56482cd038dSYoshinobu Inoue 	inp->in6p_faddr = addr->sin6_addr;
56582cd038dSYoshinobu Inoue 	soisconnected(so);
56682cd038dSYoshinobu Inoue 	return 0;
56782cd038dSYoshinobu Inoue }
56882cd038dSYoshinobu Inoue 
56982cd038dSYoshinobu Inoue static int
57082cd038dSYoshinobu Inoue rip6_shutdown(struct socket *so)
57182cd038dSYoshinobu Inoue {
57282cd038dSYoshinobu Inoue 	socantsendmore(so);
57382cd038dSYoshinobu Inoue 	return 0;
57482cd038dSYoshinobu Inoue }
57582cd038dSYoshinobu Inoue 
57682cd038dSYoshinobu Inoue static int
57782cd038dSYoshinobu Inoue rip6_send(struct socket *so, int flags, struct mbuf *m, struct sockaddr *nam,
57882cd038dSYoshinobu Inoue 	 struct mbuf *control, struct proc *p)
57982cd038dSYoshinobu Inoue {
58082cd038dSYoshinobu Inoue 	struct inpcb *inp = sotoinpcb(so);
58182cd038dSYoshinobu Inoue 	struct sockaddr_in6 tmp;
58282cd038dSYoshinobu Inoue 	struct sockaddr_in6 *dst;
58382cd038dSYoshinobu Inoue 
58482cd038dSYoshinobu Inoue 	if (so->so_state & SS_ISCONNECTED) {
58582cd038dSYoshinobu Inoue 		if (nam) {
58682cd038dSYoshinobu Inoue 			m_freem(m);
58782cd038dSYoshinobu Inoue 			return EISCONN;
58882cd038dSYoshinobu Inoue 		}
58982cd038dSYoshinobu Inoue 		/* XXX */
59082cd038dSYoshinobu Inoue 		bzero(&tmp, sizeof(tmp));
59182cd038dSYoshinobu Inoue 		tmp.sin6_family = AF_INET6;
59282cd038dSYoshinobu Inoue 		tmp.sin6_len = sizeof(struct sockaddr_in6);
59382cd038dSYoshinobu Inoue 		bcopy(&inp->in6p_faddr, &tmp.sin6_addr,
59482cd038dSYoshinobu Inoue 		      sizeof(struct in6_addr));
59582cd038dSYoshinobu Inoue 		dst = &tmp;
59682cd038dSYoshinobu Inoue 	} else {
59782cd038dSYoshinobu Inoue 		if (nam == NULL) {
59882cd038dSYoshinobu Inoue 			m_freem(m);
59982cd038dSYoshinobu Inoue 			return ENOTCONN;
60082cd038dSYoshinobu Inoue 		}
60182cd038dSYoshinobu Inoue 		dst = (struct sockaddr_in6 *)nam;
60282cd038dSYoshinobu Inoue 	}
60382cd038dSYoshinobu Inoue 	return rip6_output(m, so, dst, control);
60482cd038dSYoshinobu Inoue }
60582cd038dSYoshinobu Inoue 
60682cd038dSYoshinobu Inoue struct pr_usrreqs rip6_usrreqs = {
60782cd038dSYoshinobu Inoue 	rip6_abort, pru_accept_notsupp, rip6_attach, rip6_bind, rip6_connect,
60882cd038dSYoshinobu Inoue 	pru_connect2_notsupp, in6_control, rip6_detach, rip6_disconnect,
60982cd038dSYoshinobu Inoue 	pru_listen_notsupp, in6_setpeeraddr, pru_rcvd_notsupp,
61082cd038dSYoshinobu Inoue 	pru_rcvoob_notsupp, rip6_send, pru_sense_null, rip6_shutdown,
61182cd038dSYoshinobu Inoue 	in6_setsockaddr, sosend, soreceive, sopoll
61282cd038dSYoshinobu Inoue };
613