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