Home | History | Annotate | Line # | Download | only in netinet6
ip6_output.c revision 1.197
      1  1.197      maxv /*	$NetBSD: ip6_output.c,v 1.197 2018/01/31 13:57:08 maxv Exp $	*/
      2   1.33    itojun /*	$KAME: ip6_output.c,v 1.172 2001/03/25 09:55:56 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.19    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.19    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, 1990, 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.62       agc  * 3. Neither the name of the University nor the names of its contributors
     46    1.2    itojun  *    may be used to endorse or promote products derived from this software
     47    1.2    itojun  *    without specific prior written permission.
     48    1.2    itojun  *
     49    1.2    itojun  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     50    1.2    itojun  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     51    1.2    itojun  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     52    1.2    itojun  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     53    1.2    itojun  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     54    1.2    itojun  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     55    1.2    itojun  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     56    1.2    itojun  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     57    1.2    itojun  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     58    1.2    itojun  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     59    1.2    itojun  * SUCH DAMAGE.
     60    1.2    itojun  *
     61    1.2    itojun  *	@(#)ip_output.c	8.3 (Berkeley) 1/21/94
     62    1.2    itojun  */
     63   1.41     lukem 
     64   1.41     lukem #include <sys/cdefs.h>
     65  1.197      maxv __KERNEL_RCSID(0, "$NetBSD: ip6_output.c,v 1.197 2018/01/31 13:57:08 maxv Exp $");
     66    1.2    itojun 
     67  1.166     pooka #ifdef _KERNEL_OPT
     68    1.2    itojun #include "opt_inet.h"
     69   1.97    rpaulo #include "opt_inet6.h"
     70    1.4   thorpej #include "opt_ipsec.h"
     71  1.166     pooka #endif
     72    1.2    itojun 
     73    1.2    itojun #include <sys/param.h>
     74    1.2    itojun #include <sys/malloc.h>
     75    1.2    itojun #include <sys/mbuf.h>
     76    1.2    itojun #include <sys/errno.h>
     77    1.2    itojun #include <sys/socket.h>
     78    1.2    itojun #include <sys/socketvar.h>
     79  1.174       roy #include <sys/syslog.h>
     80    1.2    itojun #include <sys/systm.h>
     81    1.2    itojun #include <sys/proc.h>
     82   1.98      elad #include <sys/kauth.h>
     83    1.2    itojun 
     84    1.2    itojun #include <net/if.h>
     85    1.2    itojun #include <net/route.h>
     86   1.15   darrenr #include <net/pfil.h>
     87    1.2    itojun 
     88    1.2    itojun #include <netinet/in.h>
     89    1.2    itojun #include <netinet/in_var.h>
     90   1.14    itojun #include <netinet/ip6.h>
     91  1.159  christos #include <netinet/ip_var.h>
     92   1.14    itojun #include <netinet/icmp6.h>
     93   1.90      yamt #include <netinet/in_offload.h>
     94  1.149  christos #include <netinet/portalgo.h>
     95  1.105      yamt #include <netinet6/in6_offload.h>
     96   1.10    itojun #include <netinet6/ip6_var.h>
     97  1.128   thorpej #include <netinet6/ip6_private.h>
     98    1.2    itojun #include <netinet6/in6_pcb.h>
     99    1.2    itojun #include <netinet6/nd6.h>
    100   1.78    itojun #include <netinet6/ip6protosw.h>
    101   1.94    rpaulo #include <netinet6/scope6_var.h>
    102    1.2    itojun 
    103  1.153  christos #ifdef IPSEC
    104  1.114  degroote #include <netipsec/ipsec.h>
    105  1.114  degroote #include <netipsec/ipsec6.h>
    106  1.114  degroote #include <netipsec/key.h>
    107  1.114  degroote #include <netipsec/xform.h>
    108  1.114  degroote #endif
    109  1.114  degroote 
    110  1.114  degroote 
    111    1.9    itojun #include <net/net_osdep.h>
    112    1.9    itojun 
    113  1.154     rmind extern pfil_head_t *inet6_pfil_hook;	/* XXX */
    114   1.27   thorpej 
    115    1.2    itojun struct ip6_exthdrs {
    116    1.2    itojun 	struct mbuf *ip6e_ip6;
    117    1.2    itojun 	struct mbuf *ip6e_hbh;
    118    1.2    itojun 	struct mbuf *ip6e_dest1;
    119    1.2    itojun 	struct mbuf *ip6e_rthdr;
    120    1.2    itojun 	struct mbuf *ip6e_dest2;
    121    1.2    itojun };
    122    1.2    itojun 
    123  1.122    dyoung static int ip6_pcbopt(int, u_char *, int, struct ip6_pktopts **,
    124  1.138      elad 	kauth_cred_t, int);
    125  1.130    plunky static int ip6_getpcbopt(struct ip6_pktopts *, int, struct sockopt *);
    126  1.138      elad static int ip6_setpktopt(int, u_char *, int, struct ip6_pktopts *, kauth_cred_t,
    127  1.122    dyoung 	int, int, int);
    128  1.160  christos static int ip6_setmoptions(const struct sockopt *, struct in6pcb *);
    129  1.160  christos static int ip6_getmoptions(struct sockopt *, struct in6pcb *);
    130  1.122    dyoung static int ip6_copyexthdr(struct mbuf **, void *, int);
    131  1.122    dyoung static int ip6_insertfraghdr(struct mbuf *, struct mbuf *, int,
    132  1.122    dyoung 	struct ip6_frag **);
    133  1.122    dyoung static int ip6_insert_jumboopt(struct ip6_exthdrs *, u_int32_t);
    134  1.122    dyoung static int ip6_splithdr(struct mbuf *, struct ip6_exthdrs *);
    135  1.176     ozaki static int ip6_getpmtu(struct rtentry *, struct ifnet *, u_long *, int *);
    136  1.122    dyoung static int copypktopts(struct ip6_pktopts *, struct ip6_pktopts *, int);
    137  1.194       roy static int ip6_ifaddrvalid(const struct in6_addr *, const struct in6_addr *);
    138  1.177     ozaki static int ip6_handle_rthdr(struct ip6_rthdr *, struct ip6_hdr *);
    139   1.97    rpaulo 
    140   1.97    rpaulo #ifdef RFC2292
    141  1.130    plunky static int ip6_pcbopts(struct ip6_pktopts **, struct socket *, struct sockopt *);
    142   1.97    rpaulo #endif
    143    1.2    itojun 
    144  1.177     ozaki static int
    145  1.177     ozaki ip6_handle_rthdr(struct ip6_rthdr *rh, struct ip6_hdr *ip6)
    146  1.177     ozaki {
    147  1.177     ozaki 	struct ip6_rthdr0 *rh0;
    148  1.177     ozaki 	struct in6_addr *addr;
    149  1.177     ozaki 	struct sockaddr_in6 sa;
    150  1.177     ozaki 	int error = 0;
    151  1.177     ozaki 
    152  1.177     ozaki 	switch (rh->ip6r_type) {
    153  1.177     ozaki 	case IPV6_RTHDR_TYPE_0:
    154  1.197      maxv 		rh0 = (struct ip6_rthdr0 *)rh;
    155  1.197      maxv 		addr = (struct in6_addr *)(rh0 + 1);
    156  1.177     ozaki 
    157  1.197      maxv 		/*
    158  1.197      maxv 		 * construct a sockaddr_in6 form of the first hop.
    159  1.197      maxv 		 *
    160  1.197      maxv 		 * XXX we may not have enough information about its scope zone;
    161  1.197      maxv 		 * there is no standard API to pass the information from the
    162  1.197      maxv 		 * application.
    163  1.197      maxv 		 */
    164  1.197      maxv 		sockaddr_in6_init(&sa, addr, 0, 0, 0);
    165  1.197      maxv 		error = sa6_embedscope(&sa, ip6_use_defzone);
    166  1.197      maxv 		if (error != 0)
    167  1.197      maxv 			break;
    168  1.197      maxv 		memmove(&addr[0], &addr[1],
    169  1.197      maxv 		    sizeof(struct in6_addr) * (rh0->ip6r0_segleft - 1));
    170  1.197      maxv 		addr[rh0->ip6r0_segleft - 1] = ip6->ip6_dst;
    171  1.197      maxv 		ip6->ip6_dst = sa.sin6_addr;
    172  1.197      maxv 		/* XXX */
    173  1.197      maxv 		in6_clearscope(addr + rh0->ip6r0_segleft - 1);
    174  1.197      maxv 		break;
    175  1.177     ozaki 	default:	/* is it possible? */
    176  1.197      maxv 		error = EINVAL;
    177  1.177     ozaki 	}
    178  1.177     ozaki 
    179  1.177     ozaki 	return error;
    180  1.177     ozaki }
    181  1.177     ozaki 
    182    1.2    itojun /*
    183  1.183     ozaki  * Send an IP packet to a host.
    184  1.183     ozaki  */
    185  1.183     ozaki int
    186  1.183     ozaki ip6_if_output(struct ifnet * const ifp, struct ifnet * const origifp,
    187  1.197      maxv     struct mbuf * const m, const struct sockaddr_in6 * const dst,
    188  1.197      maxv     const struct rtentry *rt)
    189  1.183     ozaki {
    190  1.183     ozaki 	int error = 0;
    191  1.183     ozaki 
    192  1.183     ozaki 	if (rt != NULL) {
    193  1.183     ozaki 		error = rt_check_reject_route(rt, ifp);
    194  1.183     ozaki 		if (error != 0) {
    195  1.183     ozaki 			m_freem(m);
    196  1.183     ozaki 			return error;
    197  1.183     ozaki 		}
    198  1.183     ozaki 	}
    199  1.183     ozaki 
    200  1.183     ozaki 	if ((ifp->if_flags & IFF_LOOPBACK) != 0)
    201  1.183     ozaki 		error = if_output_lock(ifp, origifp, m, sin6tocsa(dst), rt);
    202  1.183     ozaki 	else
    203  1.183     ozaki 		error = if_output_lock(ifp, ifp, m, sin6tocsa(dst), rt);
    204  1.183     ozaki 	return error;
    205  1.183     ozaki }
    206  1.183     ozaki 
    207  1.183     ozaki /*
    208    1.2    itojun  * IP6 output. The packet in mbuf chain m contains a skeletal IP6
    209    1.2    itojun  * header (with pri, len, nxt, hlim, src, dst).
    210   1.52    itojun  *
    211  1.197      maxv  * This function may modify ver and hlim only. The mbuf chain containing the
    212  1.197      maxv  * packet will be freed. The mbuf opt, if present, will not be freed.
    213  1.197      maxv  *
    214  1.197      maxv  * Type of "mtu": rt_rmx.rmx_mtu is u_long, ifnet.ifr_mtu is int, and
    215  1.197      maxv  * nd_ifinfo.linkmtu is u_int32_t. So we use u_long to hold largest one,
    216   1.52    itojun  * which is rt_rmx.rmx_mtu.
    217    1.2    itojun  */
    218    1.2    itojun int
    219  1.103  christos ip6_output(
    220  1.103  christos     struct mbuf *m0,
    221  1.103  christos     struct ip6_pktopts *opt,
    222  1.118    dyoung     struct route *ro,
    223  1.103  christos     int flags,
    224  1.103  christos     struct ip6_moptions *im6o,
    225  1.191     ozaki     struct in6pcb *in6p,
    226  1.103  christos     struct ifnet **ifpp		/* XXX: just for statistics */
    227  1.103  christos )
    228    1.2    itojun {
    229    1.2    itojun 	struct ip6_hdr *ip6, *mhip6;
    230  1.171  christos 	struct ifnet *ifp = NULL, *origifp = NULL;
    231    1.2    itojun 	struct mbuf *m = m0;
    232  1.197      maxv 	int tlen, len, off;
    233  1.116   thorpej 	bool tso;
    234  1.118    dyoung 	struct route ip6route;
    235  1.176     ozaki 	struct rtentry *rt = NULL, *rt_pmtu;
    236  1.164     ozaki 	const struct sockaddr_in6 *dst;
    237  1.118    dyoung 	struct sockaddr_in6 src_sa, dst_sa;
    238    1.2    itojun 	int error = 0;
    239   1.94    rpaulo 	struct in6_ifaddr *ia = NULL;
    240    1.2    itojun 	u_long mtu;
    241   1.78    itojun 	int alwaysfrag, dontfrag;
    242    1.2    itojun 	u_int32_t optlen = 0, plen = 0, unfragpartlen = 0;
    243    1.2    itojun 	struct ip6_exthdrs exthdrs;
    244   1.94    rpaulo 	struct in6_addr finaldst, src0, dst0;
    245   1.94    rpaulo 	u_int32_t zone;
    246  1.118    dyoung 	struct route *ro_pmtu = NULL;
    247    1.2    itojun 	int hdrsplit = 0;
    248    1.2    itojun 	int needipsec = 0;
    249  1.153  christos #ifdef IPSEC
    250  1.114  degroote 	struct secpolicy *sp = NULL;
    251  1.114  degroote #endif
    252  1.170     ozaki 	struct psref psref, psref_ia;
    253  1.170     ozaki 	int bound = curlwp_bind();
    254  1.170     ozaki 	bool release_psref_ia = false;
    255  1.114  degroote 
    256  1.197      maxv #ifdef DIAGNOSTIC
    257  1.100      tron 	if ((m->m_flags & M_PKTHDR) == 0)
    258  1.100      tron 		panic("ip6_output: no HDR");
    259  1.100      tron 	if ((m->m_pkthdr.csum_flags &
    260  1.100      tron 	    (M_CSUM_TCPv4|M_CSUM_UDPv4|M_CSUM_TSOv4)) != 0) {
    261  1.100      tron 		panic("ip6_output: IPv4 checksum offload flags: %d",
    262  1.100      tron 		    m->m_pkthdr.csum_flags);
    263  1.100      tron 	}
    264  1.100      tron 	if ((m->m_pkthdr.csum_flags & (M_CSUM_TCPv6|M_CSUM_UDPv6)) ==
    265  1.100      tron 	    (M_CSUM_TCPv6|M_CSUM_UDPv6)) {
    266  1.100      tron 		panic("ip6_output: conflicting checksum offload flags: %d",
    267  1.100      tron 		    m->m_pkthdr.csum_flags);
    268  1.100      tron 	}
    269  1.100      tron #endif
    270  1.100      tron 
    271   1.89      yamt 	M_CSUM_DATA_IPv6_HL_SET(m->m_pkthdr.csum_data, sizeof(struct ip6_hdr));
    272   1.89      yamt 
    273   1.22    itojun #define MAKE_EXTHDR(hp, mp)						\
    274   1.22    itojun     do {								\
    275    1.2    itojun 	if (hp) {							\
    276    1.2    itojun 		struct ip6_ext *eh = (struct ip6_ext *)(hp);		\
    277  1.117  christos 		error = ip6_copyexthdr((mp), (void *)(hp), 		\
    278   1.49    itojun 		    ((eh)->ip6e_len + 1) << 3);				\
    279    1.2    itojun 		if (error)						\
    280    1.2    itojun 			goto freehdrs;					\
    281    1.2    itojun 	}								\
    282   1.60     perry     } while (/*CONSTCOND*/ 0)
    283   1.51    itojun 
    284  1.136    cegger 	memset(&exthdrs, 0, sizeof(exthdrs));
    285    1.2    itojun 	if (opt) {
    286    1.2    itojun 		/* Hop-by-Hop options header */
    287    1.2    itojun 		MAKE_EXTHDR(opt->ip6po_hbh, &exthdrs.ip6e_hbh);
    288  1.197      maxv 		/* Destination options header (1st part) */
    289    1.2    itojun 		MAKE_EXTHDR(opt->ip6po_dest1, &exthdrs.ip6e_dest1);
    290    1.2    itojun 		/* Routing header */
    291    1.2    itojun 		MAKE_EXTHDR(opt->ip6po_rthdr, &exthdrs.ip6e_rthdr);
    292  1.197      maxv 		/* Destination options header (2nd part) */
    293    1.2    itojun 		MAKE_EXTHDR(opt->ip6po_dest2, &exthdrs.ip6e_dest2);
    294    1.2    itojun 	}
    295    1.2    itojun 
    296    1.2    itojun 	/*
    297    1.2    itojun 	 * Calculate the total length of the extension header chain.
    298    1.2    itojun 	 * Keep the length of the unfragmentable part for fragmentation.
    299    1.2    itojun 	 */
    300    1.9    itojun 	optlen = 0;
    301  1.197      maxv 	if (exthdrs.ip6e_hbh)
    302  1.197      maxv 		optlen += exthdrs.ip6e_hbh->m_len;
    303  1.197      maxv 	if (exthdrs.ip6e_dest1)
    304  1.197      maxv 		optlen += exthdrs.ip6e_dest1->m_len;
    305  1.197      maxv 	if (exthdrs.ip6e_rthdr)
    306  1.197      maxv 		optlen += exthdrs.ip6e_rthdr->m_len;
    307    1.9    itojun 	unfragpartlen = optlen + sizeof(struct ip6_hdr);
    308    1.2    itojun 	/* NOTE: we don't add AH/ESP length here. do that later. */
    309  1.197      maxv 	if (exthdrs.ip6e_dest2)
    310  1.197      maxv 		optlen += exthdrs.ip6e_dest2->m_len;
    311    1.2    itojun 
    312  1.153  christos #ifdef IPSEC
    313  1.157  christos 	if (ipsec_used) {
    314  1.157  christos 		/* Check the security policy (SP) for the packet */
    315  1.191     ozaki 		sp = ipsec6_check_policy(m, in6p, flags, &needipsec, &error);
    316  1.157  christos 		if (error != 0) {
    317  1.157  christos 			/*
    318  1.157  christos 			 * Hack: -EINVAL is used to signal that a packet
    319  1.157  christos 			 * should be silently discarded.  This is typically
    320  1.157  christos 			 * because we asked key management for an SA and
    321  1.157  christos 			 * it was delayed (e.g. kicked up to IKE).
    322  1.157  christos 			 */
    323  1.197      maxv 			if (error == -EINVAL)
    324  1.157  christos 				error = 0;
    325  1.157  christos 			goto freehdrs;
    326  1.157  christos 		}
    327  1.157  christos 	}
    328  1.197      maxv #endif
    329  1.114  degroote 
    330  1.114  degroote 	if (needipsec &&
    331  1.114  degroote 	    (m->m_pkthdr.csum_flags & (M_CSUM_UDPv6|M_CSUM_TCPv6)) != 0) {
    332  1.114  degroote 		in6_delayed_cksum(m);
    333  1.114  degroote 		m->m_pkthdr.csum_flags &= ~(M_CSUM_UDPv6|M_CSUM_TCPv6);
    334  1.114  degroote 	}
    335  1.114  degroote 
    336    1.2    itojun 	/*
    337    1.2    itojun 	 * If we need IPsec, or there is at least one extension header,
    338    1.2    itojun 	 * separate IP6 header from the payload.
    339    1.2    itojun 	 */
    340    1.2    itojun 	if ((needipsec || optlen) && !hdrsplit) {
    341    1.2    itojun 		if ((error = ip6_splithdr(m, &exthdrs)) != 0) {
    342    1.2    itojun 			m = NULL;
    343    1.2    itojun 			goto freehdrs;
    344    1.2    itojun 		}
    345    1.2    itojun 		m = exthdrs.ip6e_ip6;
    346    1.2    itojun 		hdrsplit++;
    347    1.2    itojun 	}
    348    1.2    itojun 
    349    1.2    itojun 	/* adjust pointer */
    350    1.2    itojun 	ip6 = mtod(m, struct ip6_hdr *);
    351    1.2    itojun 
    352    1.2    itojun 	/* adjust mbuf packet header length */
    353    1.2    itojun 	m->m_pkthdr.len += optlen;
    354    1.2    itojun 	plen = m->m_pkthdr.len - sizeof(*ip6);
    355    1.2    itojun 
    356    1.2    itojun 	/* If this is a jumbo payload, insert a jumbo payload option. */
    357    1.2    itojun 	if (plen > IPV6_MAXPACKET) {
    358    1.2    itojun 		if (!hdrsplit) {
    359    1.2    itojun 			if ((error = ip6_splithdr(m, &exthdrs)) != 0) {
    360    1.2    itojun 				m = NULL;
    361    1.2    itojun 				goto freehdrs;
    362    1.2    itojun 			}
    363    1.2    itojun 			m = exthdrs.ip6e_ip6;
    364    1.2    itojun 			hdrsplit++;
    365    1.2    itojun 		}
    366    1.2    itojun 		/* adjust pointer */
    367    1.2    itojun 		ip6 = mtod(m, struct ip6_hdr *);
    368    1.2    itojun 		if ((error = ip6_insert_jumboopt(&exthdrs, plen)) != 0)
    369    1.2    itojun 			goto freehdrs;
    370   1.89      yamt 		optlen += 8; /* XXX JUMBOOPTLEN */
    371    1.2    itojun 		ip6->ip6_plen = 0;
    372    1.2    itojun 	} else
    373    1.2    itojun 		ip6->ip6_plen = htons(plen);
    374    1.2    itojun 
    375    1.2    itojun 	/*
    376    1.2    itojun 	 * Concatenate headers and fill in next header fields.
    377    1.2    itojun 	 * Here we have, on "m"
    378    1.9    itojun 	 *	IPv6 payload
    379    1.2    itojun 	 * and we insert headers accordingly.  Finally, we should be getting:
    380    1.2    itojun 	 *	IPv6 hbh dest1 rthdr ah* [esp* dest2 payload]
    381    1.9    itojun 	 *
    382    1.9    itojun 	 * during the header composing process, "m" points to IPv6 header.
    383    1.9    itojun 	 * "mprev" points to an extension header prior to esp.
    384    1.2    itojun 	 */
    385    1.2    itojun 	{
    386    1.2    itojun 		u_char *nexthdrp = &ip6->ip6_nxt;
    387    1.2    itojun 		struct mbuf *mprev = m;
    388    1.2    itojun 
    389    1.2    itojun 		/*
    390    1.2    itojun 		 * we treat dest2 specially.  this makes IPsec processing
    391   1.78    itojun 		 * much easier.  the goal here is to make mprev point the
    392   1.78    itojun 		 * mbuf prior to dest2.
    393    1.9    itojun 		 *
    394    1.9    itojun 		 * result: IPv6 dest2 payload
    395    1.9    itojun 		 * m and mprev will point to IPv6 header.
    396    1.2    itojun 		 */
    397    1.2    itojun 		if (exthdrs.ip6e_dest2) {
    398    1.2    itojun 			if (!hdrsplit)
    399    1.2    itojun 				panic("assumption failed: hdr not split");
    400    1.9    itojun 			exthdrs.ip6e_dest2->m_next = m->m_next;
    401    1.9    itojun 			m->m_next = exthdrs.ip6e_dest2;
    402    1.2    itojun 			*mtod(exthdrs.ip6e_dest2, u_char *) = ip6->ip6_nxt;
    403    1.2    itojun 			ip6->ip6_nxt = IPPROTO_DSTOPTS;
    404    1.2    itojun 		}
    405    1.2    itojun 
    406   1.22    itojun #define MAKE_CHAIN(m, mp, p, i)\
    407   1.22    itojun     do {\
    408    1.2    itojun 	if (m) {\
    409    1.2    itojun 		if (!hdrsplit) \
    410    1.2    itojun 			panic("assumption failed: hdr not split"); \
    411    1.2    itojun 		*mtod((m), u_char *) = *(p);\
    412    1.2    itojun 		*(p) = (i);\
    413    1.2    itojun 		p = mtod((m), u_char *);\
    414    1.2    itojun 		(m)->m_next = (mp)->m_next;\
    415    1.2    itojun 		(mp)->m_next = (m);\
    416    1.2    itojun 		(mp) = (m);\
    417    1.2    itojun 	}\
    418   1.60     perry     } while (/*CONSTCOND*/ 0)
    419    1.9    itojun 		/*
    420    1.9    itojun 		 * result: IPv6 hbh dest1 rthdr dest2 payload
    421    1.9    itojun 		 * m will point to IPv6 header.  mprev will point to the
    422    1.9    itojun 		 * extension header prior to dest2 (rthdr in the above case).
    423    1.9    itojun 		 */
    424   1.49    itojun 		MAKE_CHAIN(exthdrs.ip6e_hbh, mprev, nexthdrp, IPPROTO_HOPOPTS);
    425   1.49    itojun 		MAKE_CHAIN(exthdrs.ip6e_dest1, mprev, nexthdrp,
    426   1.49    itojun 		    IPPROTO_DSTOPTS);
    427   1.49    itojun 		MAKE_CHAIN(exthdrs.ip6e_rthdr, mprev, nexthdrp,
    428   1.49    itojun 		    IPPROTO_ROUTING);
    429    1.2    itojun 
    430   1.89      yamt 		M_CSUM_DATA_IPv6_HL_SET(m->m_pkthdr.csum_data,
    431   1.89      yamt 		    sizeof(struct ip6_hdr) + optlen);
    432    1.2    itojun 	}
    433    1.2    itojun 
    434  1.178     ozaki 	/* Need to save for pmtu */
    435  1.178     ozaki 	finaldst = ip6->ip6_dst;
    436  1.178     ozaki 
    437    1.2    itojun 	/*
    438    1.2    itojun 	 * If there is a routing header, replace destination address field
    439    1.2    itojun 	 * with the first hop of the routing header.
    440    1.2    itojun 	 */
    441    1.2    itojun 	if (exthdrs.ip6e_rthdr) {
    442   1.49    itojun 		struct ip6_rthdr *rh;
    443    1.2    itojun 
    444  1.197      maxv 		rh = mtod(exthdrs.ip6e_rthdr, struct ip6_rthdr *);
    445   1.94    rpaulo 
    446  1.177     ozaki 		error = ip6_handle_rthdr(rh, ip6);
    447  1.177     ozaki 		if (error != 0)
    448  1.177     ozaki 			goto bad;
    449    1.2    itojun 	}
    450    1.2    itojun 
    451    1.2    itojun 	/* Source address validation */
    452    1.2    itojun 	if (IN6_IS_ADDR_UNSPECIFIED(&ip6->ip6_src) &&
    453   1.54    itojun 	    (flags & IPV6_UNSPECSRC) == 0) {
    454    1.2    itojun 		error = EOPNOTSUPP;
    455  1.128   thorpej 		IP6_STATINC(IP6_STAT_BADSCOPE);
    456    1.2    itojun 		goto bad;
    457    1.2    itojun 	}
    458    1.2    itojun 	if (IN6_IS_ADDR_MULTICAST(&ip6->ip6_src)) {
    459    1.2    itojun 		error = EOPNOTSUPP;
    460  1.128   thorpej 		IP6_STATINC(IP6_STAT_BADSCOPE);
    461    1.2    itojun 		goto bad;
    462    1.2    itojun 	}
    463    1.2    itojun 
    464  1.128   thorpej 	IP6_STATINC(IP6_STAT_LOCALOUT);
    465    1.2    itojun 
    466    1.2    itojun 	/*
    467    1.2    itojun 	 * Route packet.
    468    1.2    itojun 	 */
    469   1.78    itojun 	/* initialize cached route */
    470  1.113    dyoung 	if (ro == NULL) {
    471  1.172     ozaki 		memset(&ip6route, 0, sizeof(ip6route));
    472    1.2    itojun 		ro = &ip6route;
    473    1.2    itojun 	}
    474    1.2    itojun 	ro_pmtu = ro;
    475    1.2    itojun 	if (opt && opt->ip6po_rthdr)
    476    1.2    itojun 		ro = &opt->ip6po_route;
    477   1.94    rpaulo 
    478  1.197      maxv 	/*
    479   1.94    rpaulo 	 * if specified, try to fill in the traffic class field.
    480   1.94    rpaulo 	 * do not override if a non-zero value is already set.
    481   1.94    rpaulo 	 * we check the diffserv field and the ecn field separately.
    482   1.94    rpaulo 	 */
    483   1.94    rpaulo 	if (opt && opt->ip6po_tclass >= 0) {
    484   1.94    rpaulo 		int mask = 0;
    485   1.94    rpaulo 
    486   1.94    rpaulo 		if ((ip6->ip6_flow & htonl(0xfc << 20)) == 0)
    487   1.94    rpaulo 			mask |= 0xfc;
    488   1.94    rpaulo 		if ((ip6->ip6_flow & htonl(0x03 << 20)) == 0)
    489   1.94    rpaulo 			mask |= 0x03;
    490   1.94    rpaulo 		if (mask != 0)
    491   1.94    rpaulo 			ip6->ip6_flow |= htonl((opt->ip6po_tclass & mask) << 20);
    492    1.2    itojun 	}
    493   1.94    rpaulo 
    494   1.94    rpaulo 	/* fill in or override the hop limit field, if necessary. */
    495   1.94    rpaulo 	if (opt && opt->ip6po_hlim != -1)
    496   1.94    rpaulo 		ip6->ip6_hlim = opt->ip6po_hlim & 0xff;
    497   1.94    rpaulo 	else if (IN6_IS_ADDR_MULTICAST(&ip6->ip6_dst)) {
    498   1.94    rpaulo 		if (im6o != NULL)
    499   1.94    rpaulo 			ip6->ip6_hlim = im6o->im6o_multicast_hlim;
    500   1.94    rpaulo 		else
    501   1.94    rpaulo 			ip6->ip6_hlim = ip6_defmcasthlim;
    502    1.2    itojun 	}
    503   1.94    rpaulo 
    504  1.153  christos #ifdef IPSEC
    505  1.114  degroote 	if (needipsec) {
    506  1.157  christos 		int s = splsoftnet();
    507  1.157  christos 		error = ipsec6_process_packet(m, sp->req);
    508  1.197      maxv 		splx(s);
    509  1.114  degroote 
    510  1.114  degroote 		/*
    511  1.114  degroote 		 * Preserve KAME behaviour: ENOENT can be returned
    512  1.114  degroote 		 * when an SA acquire is in progress.  Don't propagate
    513  1.114  degroote 		 * this to user-level; it confuses applications.
    514  1.114  degroote 		 * XXX this will go away when the SADB is redone.
    515  1.114  degroote 		 */
    516  1.114  degroote 		if (error == ENOENT)
    517  1.114  degroote 			error = 0;
    518  1.197      maxv 
    519  1.114  degroote 		goto done;
    520  1.118    dyoung 	}
    521  1.197      maxv #endif
    522  1.114  degroote 
    523   1.94    rpaulo 	/* adjust pointer */
    524   1.94    rpaulo 	ip6 = mtod(m, struct ip6_hdr *);
    525    1.2    itojun 
    526  1.123    dyoung 	sockaddr_in6_init(&dst_sa, &ip6->ip6_dst, 0, 0, 0);
    527  1.178     ozaki 
    528  1.178     ozaki 	/* We do not need a route for multicast */
    529  1.178     ozaki 	if (IN6_IS_ADDR_MULTICAST(&ip6->ip6_dst)) {
    530  1.178     ozaki 		struct in6_pktinfo *pi = NULL;
    531  1.178     ozaki 
    532  1.178     ozaki 		/*
    533  1.178     ozaki 		 * If the outgoing interface for the address is specified by
    534  1.178     ozaki 		 * the caller, use it.
    535  1.178     ozaki 		 */
    536  1.178     ozaki 		if (opt && (pi = opt->ip6po_pktinfo) != NULL) {
    537  1.178     ozaki 			/* XXX boundary check is assumed to be already done. */
    538  1.178     ozaki 			ifp = if_get_byindex(pi->ipi6_ifindex, &psref);
    539  1.178     ozaki 		} else if (im6o != NULL) {
    540  1.178     ozaki 			ifp = if_get_byindex(im6o->im6o_multicast_if_index,
    541  1.178     ozaki 			    &psref);
    542  1.178     ozaki 		}
    543  1.178     ozaki 	}
    544  1.178     ozaki 
    545  1.178     ozaki 	if (ifp == NULL) {
    546  1.178     ozaki 		error = in6_selectroute(&dst_sa, opt, &ro, &rt, true);
    547  1.178     ozaki 		if (error != 0)
    548  1.178     ozaki 			goto bad;
    549  1.178     ozaki 		ifp = if_get_byindex(rt->rt_ifp->if_index, &psref);
    550   1.94    rpaulo 	}
    551  1.178     ozaki 
    552   1.94    rpaulo 	if (rt == NULL) {
    553   1.94    rpaulo 		/*
    554   1.94    rpaulo 		 * If in6_selectroute() does not return a route entry,
    555   1.94    rpaulo 		 * dst may not have been updated.
    556   1.94    rpaulo 		 */
    557  1.145     rmind 		error = rtcache_setdst(ro, sin6tosa(&dst_sa));
    558  1.145     rmind 		if (error) {
    559  1.145     rmind 			goto bad;
    560  1.145     rmind 		}
    561   1.94    rpaulo 	}
    562    1.2    itojun 
    563   1.94    rpaulo 	/*
    564   1.94    rpaulo 	 * then rt (for unicast) and ifp must be non-NULL valid values.
    565   1.94    rpaulo 	 */
    566   1.94    rpaulo 	if ((flags & IPV6_FORWARDING) == 0) {
    567   1.94    rpaulo 		/* XXX: the FORWARDING flag can be set for mrouting. */
    568    1.9    itojun 		in6_ifstat_inc(ifp, ifs6_out_request);
    569   1.94    rpaulo 	}
    570   1.94    rpaulo 	if (rt != NULL) {
    571   1.94    rpaulo 		ia = (struct in6_ifaddr *)(rt->rt_ifa);
    572   1.94    rpaulo 		rt->rt_use++;
    573   1.94    rpaulo 	}
    574    1.9    itojun 
    575   1.94    rpaulo 	/*
    576   1.94    rpaulo 	 * The outgoing interface must be in the zone of source and
    577   1.94    rpaulo 	 * destination addresses.  We should use ia_ifp to support the
    578   1.94    rpaulo 	 * case of sending packets to an address of our own.
    579   1.94    rpaulo 	 */
    580  1.170     ozaki 	if (ia != NULL && ia->ia_ifp) {
    581   1.94    rpaulo 		origifp = ia->ia_ifp;
    582  1.173     ozaki 		if (if_is_deactivated(origifp))
    583  1.173     ozaki 			goto bad;
    584  1.184     ozaki 		if_acquire(origifp, &psref_ia);
    585  1.170     ozaki 		release_psref_ia = true;
    586  1.170     ozaki 	} else
    587   1.94    rpaulo 		origifp = ifp;
    588    1.2    itojun 
    589   1.94    rpaulo 	src0 = ip6->ip6_src;
    590   1.94    rpaulo 	if (in6_setscope(&src0, origifp, &zone))
    591   1.94    rpaulo 		goto badscope;
    592  1.123    dyoung 	sockaddr_in6_init(&src_sa, &ip6->ip6_src, 0, 0, 0);
    593   1.94    rpaulo 	if (sa6_recoverscope(&src_sa) || zone != src_sa.sin6_scope_id)
    594   1.94    rpaulo 		goto badscope;
    595   1.94    rpaulo 
    596   1.94    rpaulo 	dst0 = ip6->ip6_dst;
    597   1.94    rpaulo 	if (in6_setscope(&dst0, origifp, &zone))
    598   1.94    rpaulo 		goto badscope;
    599   1.94    rpaulo 	/* re-initialize to be sure */
    600  1.123    dyoung 	sockaddr_in6_init(&dst_sa, &ip6->ip6_dst, 0, 0, 0);
    601   1.94    rpaulo 	if (sa6_recoverscope(&dst_sa) || zone != dst_sa.sin6_scope_id)
    602   1.94    rpaulo 		goto badscope;
    603   1.94    rpaulo 
    604   1.94    rpaulo 	/* scope check is done. */
    605   1.94    rpaulo 
    606  1.175       roy 	/* Ensure we only send from a valid address. */
    607  1.194       roy 	if ((ifp->if_flags & IFF_LOOPBACK) == 0 &&
    608  1.194       roy 	    (error = ip6_ifaddrvalid(&src0, &dst0)) != 0)
    609  1.194       roy 	{
    610  1.181       ryo 		char ip6buf[INET6_ADDRSTRLEN];
    611  1.174       roy 		nd6log(LOG_ERR,
    612  1.174       roy 		    "refusing to send from invalid address %s (pid %d)\n",
    613  1.182  christos 		    IN6_PRINT(ip6buf, &src0), curproc->p_pid);
    614  1.175       roy 		IP6_STATINC(IP6_STAT_ODROPPED);
    615  1.175       roy 		in6_ifstat_inc(origifp, ifs6_out_discard);
    616  1.175       roy 		if (error == 1)
    617  1.175       roy 			/*
    618  1.175       roy 			 * Address exists, but is tentative or detached.
    619  1.174       roy 			 * We can't send from it because it's invalid,
    620  1.175       roy 			 * so we drop the packet.
    621  1.175       roy 			 */
    622  1.174       roy 			error = 0;
    623  1.174       roy 		else
    624  1.174       roy 			error = EADDRNOTAVAIL;
    625  1.174       roy 		goto bad;
    626  1.174       roy 	}
    627  1.174       roy 
    628  1.178     ozaki 	if (rt != NULL && (rt->rt_flags & RTF_GATEWAY) &&
    629  1.178     ozaki 	    !IN6_IS_ADDR_MULTICAST(&ip6->ip6_dst))
    630  1.178     ozaki 		dst = satocsin6(rt->rt_gateway);
    631  1.164     ozaki 	else
    632  1.118    dyoung 		dst = satocsin6(rtcache_getdst(ro));
    633    1.2    itojun 
    634   1.94    rpaulo 	/*
    635   1.94    rpaulo 	 * XXXXXX: original code follows:
    636   1.94    rpaulo 	 */
    637   1.94    rpaulo 	if (!IN6_IS_ADDR_MULTICAST(&ip6->ip6_dst))
    638   1.94    rpaulo 		m->m_flags &= ~(M_BCAST | M_MCAST);	/* just in case */
    639   1.94    rpaulo 	else {
    640  1.187     ozaki 		bool ingroup;
    641    1.2    itojun 
    642   1.94    rpaulo 		m->m_flags = (m->m_flags & ~M_BCAST) | M_MCAST;
    643    1.9    itojun 
    644    1.9    itojun 		in6_ifstat_inc(ifp, ifs6_out_mcast);
    645    1.9    itojun 
    646    1.2    itojun 		/*
    647    1.2    itojun 		 * Confirm that the outgoing interface supports multicast.
    648    1.2    itojun 		 */
    649   1.94    rpaulo 		if (!(ifp->if_flags & IFF_MULTICAST)) {
    650  1.128   thorpej 			IP6_STATINC(IP6_STAT_NOROUTE);
    651    1.9    itojun 			in6_ifstat_inc(ifp, ifs6_out_discard);
    652    1.2    itojun 			error = ENETUNREACH;
    653    1.2    itojun 			goto bad;
    654    1.2    itojun 		}
    655   1.94    rpaulo 
    656  1.187     ozaki 		ingroup = in6_multi_group(&ip6->ip6_dst, ifp);
    657  1.187     ozaki 		if (ingroup && (im6o == NULL || im6o->im6o_multicast_loop)) {
    658    1.2    itojun 			/*
    659    1.2    itojun 			 * If we belong to the destination multicast group
    660    1.2    itojun 			 * on the outgoing interface, and the caller did not
    661    1.2    itojun 			 * forbid loopback, loop back a copy.
    662    1.2    itojun 			 */
    663  1.118    dyoung 			KASSERT(dst != NULL);
    664    1.2    itojun 			ip6_mloopback(ifp, m, dst);
    665    1.2    itojun 		} else {
    666    1.2    itojun 			/*
    667    1.2    itojun 			 * If we are acting as a multicast router, perform
    668    1.2    itojun 			 * multicast forwarding as if the packet had just
    669    1.2    itojun 			 * arrived on the interface to which we are about
    670    1.2    itojun 			 * to send.  The multicast forwarding function
    671    1.2    itojun 			 * recursively calls this function, using the
    672    1.2    itojun 			 * IPV6_FORWARDING flag to prevent infinite recursion.
    673    1.2    itojun 			 *
    674    1.2    itojun 			 * Multicasts that are looped back by ip6_mloopback(),
    675    1.2    itojun 			 * above, will be forwarded by the ip6_input() routine,
    676    1.2    itojun 			 * if necessary.
    677    1.2    itojun 			 */
    678    1.2    itojun 			if (ip6_mrouter && (flags & IPV6_FORWARDING) == 0) {
    679   1.20   thorpej 				if (ip6_mforward(ip6, ifp, m) != 0) {
    680    1.2    itojun 					m_freem(m);
    681    1.2    itojun 					goto done;
    682    1.2    itojun 				}
    683    1.2    itojun 			}
    684    1.2    itojun 		}
    685    1.2    itojun 		/*
    686    1.2    itojun 		 * Multicasts with a hoplimit of zero may be looped back,
    687    1.2    itojun 		 * above, but must not be transmitted on a network.
    688    1.2    itojun 		 * Also, multicasts addressed to the loopback interface
    689    1.2    itojun 		 * are not sent -- the above call to ip6_mloopback() will
    690    1.2    itojun 		 * loop back a copy if this host actually belongs to the
    691    1.2    itojun 		 * destination group on the loopback interface.
    692    1.2    itojun 		 */
    693   1.94    rpaulo 		if (ip6->ip6_hlim == 0 || (ifp->if_flags & IFF_LOOPBACK) ||
    694   1.94    rpaulo 		    IN6_IS_ADDR_MC_INTFACELOCAL(&ip6->ip6_dst)) {
    695    1.2    itojun 			m_freem(m);
    696    1.2    itojun 			goto done;
    697    1.2    itojun 		}
    698    1.2    itojun 	}
    699    1.2    itojun 
    700    1.2    itojun 	/*
    701    1.9    itojun 	 * Fill the outgoing inteface to tell the upper layer
    702    1.9    itojun 	 * to increment per-interface statistics.
    703    1.9    itojun 	 */
    704    1.9    itojun 	if (ifpp)
    705    1.9    itojun 		*ifpp = ifp;
    706    1.9    itojun 
    707   1.45    itojun 	/* Determine path MTU. */
    708  1.176     ozaki 	/*
    709  1.176     ozaki 	 * ro_pmtu represent final destination while
    710  1.176     ozaki 	 * ro might represent immediate destination.
    711  1.176     ozaki 	 * Use ro_pmtu destination since MTU might differ.
    712  1.176     ozaki 	 */
    713  1.176     ozaki 	if (ro_pmtu != ro) {
    714  1.176     ozaki 		union {
    715  1.176     ozaki 			struct sockaddr		dst;
    716  1.176     ozaki 			struct sockaddr_in6	dst6;
    717  1.176     ozaki 		} u;
    718  1.176     ozaki 
    719  1.176     ozaki 		/* ro_pmtu may not have a cache */
    720  1.176     ozaki 		sockaddr_in6_init(&u.dst6, &finaldst, 0, 0, 0);
    721  1.176     ozaki 		rt_pmtu = rtcache_lookup(ro_pmtu, &u.dst);
    722  1.176     ozaki 	} else
    723  1.179     ozaki 		rt_pmtu = rt;
    724  1.176     ozaki 	error = ip6_getpmtu(rt_pmtu, ifp, &mtu, &alwaysfrag);
    725  1.179     ozaki 	if (rt_pmtu != NULL && rt_pmtu != rt)
    726  1.179     ozaki 		rtcache_unref(rt_pmtu, ro_pmtu);
    727  1.176     ozaki 	if (error != 0)
    728   1.45    itojun 		goto bad;
    729   1.45    itojun 
    730    1.9    itojun 	/*
    731   1.45    itojun 	 * The caller of this function may specify to use the minimum MTU
    732   1.45    itojun 	 * in some cases.
    733   1.97    rpaulo 	 * An advanced API option (IPV6_USE_MIN_MTU) can also override MTU
    734   1.97    rpaulo 	 * setting.  The logic is a bit complicated; by default, unicast
    735   1.97    rpaulo 	 * packets will follow path MTU while multicast packets will be sent at
    736   1.97    rpaulo 	 * the minimum MTU.  If IP6PO_MINMTU_ALL is specified, all packets
    737   1.97    rpaulo 	 * including unicast ones will be sent at the minimum MTU.  Multicast
    738   1.97    rpaulo 	 * packets will always be sent at the minimum MTU unless
    739   1.97    rpaulo 	 * IP6PO_MINMTU_DISABLE is explicitly specified.
    740   1.97    rpaulo 	 * See RFC 3542 for more details.
    741    1.2    itojun 	 */
    742   1.45    itojun 	if (mtu > IPV6_MMTU) {
    743   1.45    itojun 		if ((flags & IPV6_MINMTU))
    744   1.45    itojun 			mtu = IPV6_MMTU;
    745   1.97    rpaulo 		else if (opt && opt->ip6po_minmtu == IP6PO_MINMTU_ALL)
    746   1.97    rpaulo 			mtu = IPV6_MMTU;
    747   1.97    rpaulo 		else if (IN6_IS_ADDR_MULTICAST(&ip6->ip6_dst) &&
    748   1.97    rpaulo 			 (opt == NULL ||
    749   1.97    rpaulo 			  opt->ip6po_minmtu != IP6PO_MINMTU_DISABLE)) {
    750   1.97    rpaulo 			mtu = IPV6_MMTU;
    751   1.97    rpaulo 		}
    752   1.43    itojun 	}
    753   1.43    itojun 
    754   1.94    rpaulo 	/*
    755   1.94    rpaulo 	 * clear embedded scope identifiers if necessary.
    756   1.94    rpaulo 	 * in6_clearscope will touch the addresses only when necessary.
    757   1.94    rpaulo 	 */
    758   1.94    rpaulo 	in6_clearscope(&ip6->ip6_src);
    759   1.94    rpaulo 	in6_clearscope(&ip6->ip6_dst);
    760    1.2    itojun 
    761    1.2    itojun 	/*
    762    1.2    itojun 	 * If the outgoing packet contains a hop-by-hop options header,
    763    1.2    itojun 	 * it must be examined and processed even by the source node.
    764    1.2    itojun 	 * (RFC 2460, section 4.)
    765    1.2    itojun 	 */
    766  1.143  drochner 	if (ip6->ip6_nxt == IPV6_HOPOPTS) {
    767    1.5    itojun 		u_int32_t dummy1; /* XXX unused */
    768    1.2    itojun 		u_int32_t dummy2; /* XXX unused */
    769  1.143  drochner 		int hoff = sizeof(struct ip6_hdr);
    770    1.2    itojun 
    771  1.143  drochner 		if (ip6_hopopts_input(&dummy1, &dummy2, &m, &hoff)) {
    772    1.2    itojun 			/* m was already freed at this point */
    773  1.197      maxv 			error = EINVAL;
    774    1.2    itojun 			goto done;
    775    1.2    itojun 		}
    776  1.143  drochner 
    777  1.143  drochner 		ip6 = mtod(m, struct ip6_hdr *);
    778    1.2    itojun 	}
    779    1.2    itojun 
    780   1.15   darrenr 	/*
    781   1.15   darrenr 	 * Run through list of hooks for output packets.
    782   1.15   darrenr 	 */
    783  1.154     rmind 	if ((error = pfil_run_hooks(inet6_pfil_hook, &m, ifp, PFIL_OUT)) != 0)
    784   1.27   thorpej 		goto done;
    785   1.27   thorpej 	if (m == NULL)
    786   1.27   thorpej 		goto done;
    787   1.27   thorpej 	ip6 = mtod(m, struct ip6_hdr *);
    788  1.154     rmind 
    789    1.2    itojun 	/*
    790    1.2    itojun 	 * Send the packet to the outgoing interface.
    791   1.19    itojun 	 * If necessary, do IPv6 fragmentation before sending.
    792   1.78    itojun 	 *
    793   1.78    itojun 	 * the logic here is rather complex:
    794   1.78    itojun 	 * 1: normal case (dontfrag == 0, alwaysfrag == 0)
    795   1.78    itojun 	 * 1-a:	send as is if tlen <= path mtu
    796   1.78    itojun 	 * 1-b:	fragment if tlen > path mtu
    797   1.78    itojun 	 *
    798   1.78    itojun 	 * 2: if user asks us not to fragment (dontfrag == 1)
    799   1.78    itojun 	 * 2-a:	send as is if tlen <= interface mtu
    800   1.78    itojun 	 * 2-b:	error if tlen > interface mtu
    801   1.78    itojun 	 *
    802   1.78    itojun 	 * 3: if we always need to attach fragment header (alwaysfrag == 1)
    803   1.78    itojun 	 *	always fragment
    804   1.78    itojun 	 *
    805   1.78    itojun 	 * 4: if dontfrag == 1 && alwaysfrag == 1
    806   1.78    itojun 	 *	error, as we cannot handle this conflicting request
    807    1.2    itojun 	 */
    808    1.2    itojun 	tlen = m->m_pkthdr.len;
    809  1.105      yamt 	tso = (m->m_pkthdr.csum_flags & M_CSUM_TSOv6) != 0;
    810   1.97    rpaulo 	if (opt && (opt->ip6po_flags & IP6PO_DONTFRAG))
    811   1.97    rpaulo 		dontfrag = 1;
    812   1.97    rpaulo 	else
    813   1.97    rpaulo 		dontfrag = 0;
    814   1.97    rpaulo 
    815   1.78    itojun 	if (dontfrag && alwaysfrag) {	/* case 4 */
    816   1.78    itojun 		/* conflicting request - can't transmit */
    817   1.78    itojun 		error = EMSGSIZE;
    818   1.78    itojun 		goto bad;
    819   1.78    itojun 	}
    820  1.105      yamt 	if (dontfrag && (!tso && tlen > IN6_LINKMTU(ifp))) {	/* case 2-b */
    821   1.78    itojun 		/*
    822   1.78    itojun 		 * Even if the DONTFRAG option is specified, we cannot send the
    823   1.78    itojun 		 * packet when the data length is larger than the MTU of the
    824   1.78    itojun 		 * outgoing interface.
    825   1.78    itojun 		 * Notify the error by sending IPV6_PATHMTU ancillary data as
    826   1.78    itojun 		 * well as returning an error code (the latter is not described
    827   1.78    itojun 		 * in the API spec.)
    828   1.78    itojun 		 */
    829   1.78    itojun 		u_int32_t mtu32;
    830   1.78    itojun 		struct ip6ctlparam ip6cp;
    831   1.78    itojun 
    832   1.78    itojun 		mtu32 = (u_int32_t)mtu;
    833  1.136    cegger 		memset(&ip6cp, 0, sizeof(ip6cp));
    834   1.78    itojun 		ip6cp.ip6c_cmdarg = (void *)&mtu32;
    835  1.115    dyoung 		pfctlinput2(PRC_MSGSIZE,
    836  1.118    dyoung 		    rtcache_getdst(ro_pmtu), &ip6cp);
    837   1.78    itojun 
    838   1.78    itojun 		error = EMSGSIZE;
    839   1.78    itojun 		goto bad;
    840   1.78    itojun 	}
    841   1.97    rpaulo 
    842   1.78    itojun 	/*
    843   1.78    itojun 	 * transmit packet without fragmentation
    844   1.78    itojun 	 */
    845  1.105      yamt 	if (dontfrag || (!alwaysfrag && (tlen <= mtu || tso))) {
    846  1.105      yamt 		/* case 1-a and 2-a */
    847   1.26    itojun 		struct in6_ifaddr *ia6;
    848   1.89      yamt 		int sw_csum;
    849  1.173     ozaki 		int s;
    850   1.78    itojun 
    851   1.26    itojun 		ip6 = mtod(m, struct ip6_hdr *);
    852  1.173     ozaki 		s = pserialize_read_enter();
    853   1.26    itojun 		ia6 = in6_ifawithifp(ifp, &ip6->ip6_src);
    854   1.26    itojun 		if (ia6) {
    855   1.42    itojun 			/* Record statistics for this interface address. */
    856   1.78    itojun 			ia6->ia_ifa.ifa_data.ifad_outbytes += m->m_pkthdr.len;
    857    1.9    itojun 		}
    858  1.173     ozaki 		pserialize_read_exit(s);
    859   1.89      yamt 
    860   1.89      yamt 		sw_csum = m->m_pkthdr.csum_flags & ~ifp->if_csum_flags_tx;
    861   1.89      yamt 		if ((sw_csum & (M_CSUM_UDPv6|M_CSUM_TCPv6)) != 0) {
    862   1.90      yamt 			if (IN6_NEED_CHECKSUM(ifp,
    863   1.90      yamt 			    sw_csum & (M_CSUM_UDPv6|M_CSUM_TCPv6))) {
    864   1.90      yamt 				in6_delayed_cksum(m);
    865   1.90      yamt 			}
    866   1.89      yamt 			m->m_pkthdr.csum_flags &= ~(M_CSUM_UDPv6|M_CSUM_TCPv6);
    867   1.89      yamt 		}
    868   1.89      yamt 
    869  1.118    dyoung 		KASSERT(dst != NULL);
    870  1.105      yamt 		if (__predict_true(!tso ||
    871  1.105      yamt 		    (ifp->if_capenable & IFCAP_TSOv6) != 0)) {
    872  1.183     ozaki 			error = ip6_if_output(ifp, origifp, m, dst, rt);
    873  1.105      yamt 		} else {
    874  1.105      yamt 			error = ip6_tso_output(ifp, origifp, m, dst, rt);
    875  1.105      yamt 		}
    876    1.2    itojun 		goto done;
    877   1.78    itojun 	}
    878   1.78    itojun 
    879  1.105      yamt 	if (tso) {
    880  1.105      yamt 		error = EINVAL; /* XXX */
    881  1.105      yamt 		goto bad;
    882  1.105      yamt 	}
    883  1.105      yamt 
    884   1.78    itojun 	/*
    885   1.78    itojun 	 * try to fragment the packet.  case 1-b and 3
    886   1.78    itojun 	 */
    887   1.78    itojun 	if (mtu < IPV6_MMTU) {
    888   1.78    itojun 		/* path MTU cannot be less than IPV6_MMTU */
    889    1.2    itojun 		error = EMSGSIZE;
    890    1.9    itojun 		in6_ifstat_inc(ifp, ifs6_out_fragfail);
    891    1.2    itojun 		goto bad;
    892   1.78    itojun 	} else if (ip6->ip6_plen == 0) {
    893   1.78    itojun 		/* jumbo payload cannot be fragmented */
    894    1.2    itojun 		error = EMSGSIZE;
    895    1.9    itojun 		in6_ifstat_inc(ifp, ifs6_out_fragfail);
    896    1.2    itojun 		goto bad;
    897    1.2    itojun 	} else {
    898  1.197      maxv 		const u_int32_t id = htonl(ip6_randomid());
    899    1.2    itojun 		struct mbuf **mnext, *m_frgpart;
    900  1.197      maxv 		const int hlen = unfragpartlen;
    901    1.2    itojun 		struct ip6_frag *ip6f;
    902    1.2    itojun 		u_char nextproto;
    903  1.197      maxv #if 0		/* see below */
    904   1.78    itojun 		struct ip6ctlparam ip6cp;
    905   1.78    itojun 		u_int32_t mtu32;
    906   1.99    rpaulo #endif
    907    1.2    itojun 
    908    1.2    itojun 		if (mtu > IPV6_MAXPACKET)
    909    1.2    itojun 			mtu = IPV6_MAXPACKET;
    910   1.78    itojun 
    911   1.99    rpaulo #if 0
    912   1.99    rpaulo 		/*
    913   1.99    rpaulo 		 * It is believed this code is a leftover from the
    914   1.99    rpaulo 		 * development of the IPV6_RECVPATHMTU sockopt and
    915   1.99    rpaulo 		 * associated work to implement RFC3542.
    916   1.99    rpaulo 		 * It's not entirely clear what the intent of the API
    917   1.99    rpaulo 		 * is at this point, so disable this code for now.
    918   1.99    rpaulo 		 * The IPV6_RECVPATHMTU sockopt and/or IPV6_DONTFRAG
    919   1.99    rpaulo 		 * will send notifications if the application requests.
    920   1.99    rpaulo 		 */
    921   1.99    rpaulo 
    922   1.78    itojun 		/* Notify a proper path MTU to applications. */
    923   1.78    itojun 		mtu32 = (u_int32_t)mtu;
    924  1.136    cegger 		memset(&ip6cp, 0, sizeof(ip6cp));
    925   1.78    itojun 		ip6cp.ip6c_cmdarg = (void *)&mtu32;
    926  1.115    dyoung 		pfctlinput2(PRC_MSGSIZE,
    927  1.118    dyoung 		    rtcache_getdst(ro_pmtu), &ip6cp);
    928   1.99    rpaulo #endif
    929   1.78    itojun 
    930  1.197      maxv 		/*
    931  1.197      maxv 		 * Must be able to put at least 8 bytes per fragment.
    932  1.197      maxv 		 */
    933    1.2    itojun 		len = (mtu - hlen - sizeof(struct ip6_frag)) & ~7;
    934    1.2    itojun 		if (len < 8) {
    935    1.2    itojun 			error = EMSGSIZE;
    936    1.9    itojun 			in6_ifstat_inc(ifp, ifs6_out_fragfail);
    937    1.2    itojun 			goto bad;
    938    1.2    itojun 		}
    939    1.2    itojun 
    940    1.2    itojun 		mnext = &m->m_nextpkt;
    941    1.2    itojun 
    942    1.2    itojun 		/*
    943    1.2    itojun 		 * Change the next header field of the last header in the
    944    1.2    itojun 		 * unfragmentable part.
    945    1.2    itojun 		 */
    946    1.2    itojun 		if (exthdrs.ip6e_rthdr) {
    947    1.2    itojun 			nextproto = *mtod(exthdrs.ip6e_rthdr, u_char *);
    948    1.2    itojun 			*mtod(exthdrs.ip6e_rthdr, u_char *) = IPPROTO_FRAGMENT;
    949   1.19    itojun 		} else if (exthdrs.ip6e_dest1) {
    950    1.2    itojun 			nextproto = *mtod(exthdrs.ip6e_dest1, u_char *);
    951    1.2    itojun 			*mtod(exthdrs.ip6e_dest1, u_char *) = IPPROTO_FRAGMENT;
    952   1.19    itojun 		} else if (exthdrs.ip6e_hbh) {
    953    1.2    itojun 			nextproto = *mtod(exthdrs.ip6e_hbh, u_char *);
    954    1.2    itojun 			*mtod(exthdrs.ip6e_hbh, u_char *) = IPPROTO_FRAGMENT;
    955   1.19    itojun 		} else {
    956    1.2    itojun 			nextproto = ip6->ip6_nxt;
    957    1.2    itojun 			ip6->ip6_nxt = IPPROTO_FRAGMENT;
    958    1.2    itojun 		}
    959    1.2    itojun 
    960   1.89      yamt 		if ((m->m_pkthdr.csum_flags & (M_CSUM_UDPv6|M_CSUM_TCPv6))
    961   1.89      yamt 		    != 0) {
    962   1.90      yamt 			if (IN6_NEED_CHECKSUM(ifp,
    963   1.90      yamt 			    m->m_pkthdr.csum_flags &
    964   1.90      yamt 			    (M_CSUM_UDPv6|M_CSUM_TCPv6))) {
    965   1.90      yamt 				in6_delayed_cksum(m);
    966   1.90      yamt 			}
    967   1.89      yamt 			m->m_pkthdr.csum_flags &= ~(M_CSUM_UDPv6|M_CSUM_TCPv6);
    968   1.89      yamt 		}
    969   1.89      yamt 
    970    1.2    itojun 		/*
    971    1.2    itojun 		 * Loop through length of segment after first fragment,
    972   1.42    itojun 		 * make new header and copy data of each part and link onto
    973   1.42    itojun 		 * chain.
    974    1.2    itojun 		 */
    975    1.2    itojun 		m0 = m;
    976    1.2    itojun 		for (off = hlen; off < tlen; off += len) {
    977   1.68    itojun 			struct mbuf *mlast;
    978   1.68    itojun 
    979    1.2    itojun 			MGETHDR(m, M_DONTWAIT, MT_HEADER);
    980    1.2    itojun 			if (!m) {
    981    1.2    itojun 				error = ENOBUFS;
    982  1.128   thorpej 				IP6_STATINC(IP6_STAT_ODROPPED);
    983    1.2    itojun 				goto sendorfree;
    984    1.2    itojun 			}
    985  1.167     ozaki 			m_reset_rcvif(m);
    986    1.2    itojun 			m->m_flags = m0->m_flags & M_COPYFLAGS;
    987    1.2    itojun 			*mnext = m;
    988    1.2    itojun 			mnext = &m->m_nextpkt;
    989    1.2    itojun 			m->m_data += max_linkhdr;
    990    1.2    itojun 			mhip6 = mtod(m, struct ip6_hdr *);
    991    1.2    itojun 			*mhip6 = *ip6;
    992    1.2    itojun 			m->m_len = sizeof(*mhip6);
    993  1.197      maxv 
    994  1.152       gdt 			ip6f = NULL;
    995   1.42    itojun 			error = ip6_insertfraghdr(m0, m, hlen, &ip6f);
    996   1.42    itojun 			if (error) {
    997  1.128   thorpej 				IP6_STATINC(IP6_STAT_ODROPPED);
    998    1.2    itojun 				goto sendorfree;
    999    1.2    itojun 			}
   1000  1.197      maxv 
   1001  1.197      maxv 			/* Fill in the Frag6 Header */
   1002   1.69    itojun 			ip6f->ip6f_offlg = htons((u_int16_t)((off - hlen) & ~7));
   1003    1.2    itojun 			if (off + len >= tlen)
   1004    1.2    itojun 				len = tlen - off;
   1005    1.2    itojun 			else
   1006    1.2    itojun 				ip6f->ip6f_offlg |= IP6F_MORE_FRAG;
   1007  1.197      maxv 			ip6f->ip6f_reserved = 0;
   1008  1.197      maxv 			ip6f->ip6f_ident = id;
   1009  1.197      maxv 			ip6f->ip6f_nxt = nextproto;
   1010  1.197      maxv 
   1011   1.69    itojun 			mhip6->ip6_plen = htons((u_int16_t)(len + hlen +
   1012   1.49    itojun 			    sizeof(*ip6f) - sizeof(struct ip6_hdr)));
   1013  1.197      maxv 			if ((m_frgpart = m_copy(m0, off, len)) == NULL) {
   1014    1.2    itojun 				error = ENOBUFS;
   1015  1.128   thorpej 				IP6_STATINC(IP6_STAT_ODROPPED);
   1016    1.2    itojun 				goto sendorfree;
   1017    1.2    itojun 			}
   1018   1.68    itojun 			for (mlast = m; mlast->m_next; mlast = mlast->m_next)
   1019   1.68    itojun 				;
   1020   1.68    itojun 			mlast->m_next = m_frgpart;
   1021  1.197      maxv 
   1022    1.2    itojun 			m->m_pkthdr.len = len + hlen + sizeof(*ip6f);
   1023  1.167     ozaki 			m_reset_rcvif(m);
   1024  1.128   thorpej 			IP6_STATINC(IP6_STAT_OFRAGMENTS);
   1025    1.9    itojun 			in6_ifstat_inc(ifp, ifs6_out_fragcreat);
   1026    1.2    itojun 		}
   1027    1.9    itojun 
   1028    1.9    itojun 		in6_ifstat_inc(ifp, ifs6_out_fragok);
   1029    1.2    itojun 	}
   1030    1.2    itojun 
   1031    1.2    itojun sendorfree:
   1032    1.2    itojun 	m = m0->m_nextpkt;
   1033    1.2    itojun 	m0->m_nextpkt = 0;
   1034    1.2    itojun 	m_freem(m0);
   1035    1.2    itojun 	for (m0 = m; m; m = m0) {
   1036    1.2    itojun 		m0 = m->m_nextpkt;
   1037    1.2    itojun 		m->m_nextpkt = 0;
   1038    1.2    itojun 		if (error == 0) {
   1039   1.26    itojun 			struct in6_ifaddr *ia6;
   1040  1.173     ozaki 			int s;
   1041   1.26    itojun 			ip6 = mtod(m, struct ip6_hdr *);
   1042  1.173     ozaki 			s = pserialize_read_enter();
   1043   1.26    itojun 			ia6 = in6_ifawithifp(ifp, &ip6->ip6_src);
   1044   1.26    itojun 			if (ia6) {
   1045   1.42    itojun 				/*
   1046   1.42    itojun 				 * Record statistics for this interface
   1047   1.42    itojun 				 * address.
   1048   1.42    itojun 				 */
   1049   1.26    itojun 				ia6->ia_ifa.ifa_data.ifad_outbytes +=
   1050   1.78    itojun 				    m->m_pkthdr.len;
   1051    1.9    itojun 			}
   1052  1.173     ozaki 			pserialize_read_exit(s);
   1053  1.118    dyoung 			KASSERT(dst != NULL);
   1054  1.183     ozaki 			error = ip6_if_output(ifp, origifp, m, dst, rt);
   1055   1.19    itojun 		} else
   1056    1.2    itojun 			m_freem(m);
   1057    1.2    itojun 	}
   1058    1.2    itojun 
   1059    1.2    itojun 	if (error == 0)
   1060  1.128   thorpej 		IP6_STATINC(IP6_STAT_FRAGMENTED);
   1061    1.2    itojun 
   1062    1.2    itojun done:
   1063  1.179     ozaki 	rtcache_unref(rt, ro);
   1064  1.172     ozaki 	if (ro == &ip6route)
   1065  1.172     ozaki 		rtcache_free(&ip6route);
   1066  1.153  christos #ifdef IPSEC
   1067  1.114  degroote 	if (sp != NULL)
   1068  1.193     ozaki 		KEY_SP_UNREF(&sp);
   1069  1.197      maxv #endif
   1070  1.170     ozaki 	if_put(ifp, &psref);
   1071  1.170     ozaki 	if (release_psref_ia)
   1072  1.170     ozaki 		if_put(origifp, &psref_ia);
   1073  1.170     ozaki 	curlwp_bindx(bound);
   1074    1.2    itojun 
   1075  1.197      maxv 	return error;
   1076    1.2    itojun 
   1077    1.2    itojun freehdrs:
   1078  1.197      maxv 	m_freem(exthdrs.ip6e_hbh);
   1079    1.2    itojun 	m_freem(exthdrs.ip6e_dest1);
   1080    1.2    itojun 	m_freem(exthdrs.ip6e_rthdr);
   1081    1.2    itojun 	m_freem(exthdrs.ip6e_dest2);
   1082   1.48    itojun 	/* FALLTHROUGH */
   1083    1.2    itojun bad:
   1084    1.2    itojun 	m_freem(m);
   1085    1.2    itojun 	goto done;
   1086  1.197      maxv 
   1087  1.118    dyoung badscope:
   1088  1.128   thorpej 	IP6_STATINC(IP6_STAT_BADSCOPE);
   1089  1.118    dyoung 	in6_ifstat_inc(origifp, ifs6_out_discard);
   1090  1.118    dyoung 	if (error == 0)
   1091  1.118    dyoung 		error = EHOSTUNREACH; /* XXX */
   1092  1.118    dyoung 	goto bad;
   1093    1.2    itojun }
   1094    1.2    itojun 
   1095    1.2    itojun static int
   1096  1.119  christos ip6_copyexthdr(struct mbuf **mp, void *hdr, int hlen)
   1097    1.2    itojun {
   1098    1.2    itojun 	struct mbuf *m;
   1099    1.2    itojun 
   1100    1.2    itojun 	if (hlen > MCLBYTES)
   1101  1.197      maxv 		return ENOBUFS; /* XXX */
   1102    1.2    itojun 
   1103    1.2    itojun 	MGET(m, M_DONTWAIT, MT_DATA);
   1104    1.2    itojun 	if (!m)
   1105  1.197      maxv 		return ENOBUFS;
   1106    1.2    itojun 
   1107    1.2    itojun 	if (hlen > MLEN) {
   1108    1.2    itojun 		MCLGET(m, M_DONTWAIT);
   1109    1.2    itojun 		if ((m->m_flags & M_EXT) == 0) {
   1110    1.2    itojun 			m_free(m);
   1111  1.197      maxv 			return ENOBUFS;
   1112    1.2    itojun 		}
   1113    1.2    itojun 	}
   1114    1.2    itojun 	m->m_len = hlen;
   1115    1.2    itojun 	if (hdr)
   1116  1.117  christos 		bcopy(hdr, mtod(m, void *), hlen);
   1117    1.2    itojun 
   1118    1.2    itojun 	*mp = m;
   1119  1.197      maxv 	return 0;
   1120    1.2    itojun }
   1121    1.2    itojun 
   1122    1.2    itojun /*
   1123   1.89      yamt  * Process a delayed payload checksum calculation.
   1124   1.89      yamt  */
   1125   1.89      yamt void
   1126   1.89      yamt in6_delayed_cksum(struct mbuf *m)
   1127   1.89      yamt {
   1128   1.89      yamt 	uint16_t csum, offset;
   1129   1.89      yamt 
   1130   1.89      yamt 	KASSERT((m->m_pkthdr.csum_flags & (M_CSUM_UDPv6|M_CSUM_TCPv6)) != 0);
   1131   1.89      yamt 	KASSERT((~m->m_pkthdr.csum_flags & (M_CSUM_UDPv6|M_CSUM_TCPv6)) != 0);
   1132   1.89      yamt 	KASSERT((m->m_pkthdr.csum_flags
   1133   1.89      yamt 	    & (M_CSUM_UDPv4|M_CSUM_TCPv4|M_CSUM_TSOv4)) == 0);
   1134   1.89      yamt 
   1135   1.89      yamt 	offset = M_CSUM_DATA_IPv6_HL(m->m_pkthdr.csum_data);
   1136   1.89      yamt 	csum = in6_cksum(m, 0, offset, m->m_pkthdr.len - offset);
   1137   1.89      yamt 	if (csum == 0 && (m->m_pkthdr.csum_flags & M_CSUM_UDPv6) != 0) {
   1138   1.89      yamt 		csum = 0xffff;
   1139   1.89      yamt 	}
   1140   1.89      yamt 
   1141   1.89      yamt 	offset += M_CSUM_DATA_IPv6_OFFSET(m->m_pkthdr.csum_data);
   1142   1.89      yamt 	if ((offset + sizeof(csum)) > m->m_len) {
   1143   1.89      yamt 		m_copyback(m, offset, sizeof(csum), &csum);
   1144   1.89      yamt 	} else {
   1145  1.117  christos 		*(uint16_t *)(mtod(m, char *) + offset) = csum;
   1146   1.89      yamt 	}
   1147   1.89      yamt }
   1148   1.89      yamt 
   1149   1.89      yamt /*
   1150   1.19    itojun  * Insert jumbo payload option.
   1151    1.2    itojun  */
   1152    1.2    itojun static int
   1153  1.119  christos ip6_insert_jumboopt(struct ip6_exthdrs *exthdrs, u_int32_t plen)
   1154    1.2    itojun {
   1155    1.2    itojun 	struct mbuf *mopt;
   1156   1.56    itojun 	u_int8_t *optbuf;
   1157   1.25    itojun 	u_int32_t v;
   1158    1.2    itojun 
   1159    1.2    itojun #define JUMBOOPTLEN	8	/* length of jumbo payload option and padding */
   1160    1.2    itojun 
   1161    1.2    itojun 	/*
   1162    1.2    itojun 	 * If there is no hop-by-hop options header, allocate new one.
   1163    1.2    itojun 	 * If there is one but it doesn't have enough space to store the
   1164    1.2    itojun 	 * jumbo payload option, allocate a cluster to store the whole options.
   1165    1.2    itojun 	 * Otherwise, use it to store the options.
   1166    1.2    itojun 	 */
   1167    1.2    itojun 	if (exthdrs->ip6e_hbh == 0) {
   1168    1.2    itojun 		MGET(mopt, M_DONTWAIT, MT_DATA);
   1169    1.2    itojun 		if (mopt == 0)
   1170   1.57    itojun 			return (ENOBUFS);
   1171    1.2    itojun 		mopt->m_len = JUMBOOPTLEN;
   1172   1.56    itojun 		optbuf = mtod(mopt, u_int8_t *);
   1173    1.2    itojun 		optbuf[1] = 0;	/* = ((JUMBOOPTLEN) >> 3) - 1 */
   1174    1.2    itojun 		exthdrs->ip6e_hbh = mopt;
   1175   1.19    itojun 	} else {
   1176    1.2    itojun 		struct ip6_hbh *hbh;
   1177    1.2    itojun 
   1178    1.2    itojun 		mopt = exthdrs->ip6e_hbh;
   1179    1.2    itojun 		if (M_TRAILINGSPACE(mopt) < JUMBOOPTLEN) {
   1180   1.25    itojun 			/*
   1181   1.25    itojun 			 * XXX assumption:
   1182   1.25    itojun 			 * - exthdrs->ip6e_hbh is not referenced from places
   1183   1.25    itojun 			 *   other than exthdrs.
   1184   1.25    itojun 			 * - exthdrs->ip6e_hbh is not an mbuf chain.
   1185   1.25    itojun 			 */
   1186    1.2    itojun 			int oldoptlen = mopt->m_len;
   1187   1.25    itojun 			struct mbuf *n;
   1188    1.2    itojun 
   1189   1.25    itojun 			/*
   1190   1.25    itojun 			 * XXX: give up if the whole (new) hbh header does
   1191   1.25    itojun 			 * not fit even in an mbuf cluster.
   1192   1.25    itojun 			 */
   1193   1.25    itojun 			if (oldoptlen + JUMBOOPTLEN > MCLBYTES)
   1194   1.57    itojun 				return (ENOBUFS);
   1195    1.2    itojun 
   1196   1.25    itojun 			/*
   1197   1.25    itojun 			 * As a consequence, we must always prepare a cluster
   1198   1.25    itojun 			 * at this point.
   1199   1.25    itojun 			 */
   1200   1.25    itojun 			MGET(n, M_DONTWAIT, MT_DATA);
   1201   1.25    itojun 			if (n) {
   1202   1.25    itojun 				MCLGET(n, M_DONTWAIT);
   1203   1.25    itojun 				if ((n->m_flags & M_EXT) == 0) {
   1204   1.25    itojun 					m_freem(n);
   1205   1.25    itojun 					n = NULL;
   1206   1.25    itojun 				}
   1207   1.25    itojun 			}
   1208   1.25    itojun 			if (!n)
   1209   1.57    itojun 				return (ENOBUFS);
   1210   1.25    itojun 			n->m_len = oldoptlen + JUMBOOPTLEN;
   1211  1.117  christos 			bcopy(mtod(mopt, void *), mtod(n, void *),
   1212   1.78    itojun 			    oldoptlen);
   1213   1.56    itojun 			optbuf = mtod(n, u_int8_t *) + oldoptlen;
   1214   1.25    itojun 			m_freem(mopt);
   1215   1.33    itojun 			mopt = exthdrs->ip6e_hbh = n;
   1216   1.19    itojun 		} else {
   1217   1.56    itojun 			optbuf = mtod(mopt, u_int8_t *) + mopt->m_len;
   1218    1.2    itojun 			mopt->m_len += JUMBOOPTLEN;
   1219    1.2    itojun 		}
   1220    1.2    itojun 		optbuf[0] = IP6OPT_PADN;
   1221   1.58    itojun 		optbuf[1] = 0;
   1222    1.2    itojun 
   1223    1.2    itojun 		/*
   1224    1.2    itojun 		 * Adjust the header length according to the pad and
   1225    1.2    itojun 		 * the jumbo payload option.
   1226    1.2    itojun 		 */
   1227    1.2    itojun 		hbh = mtod(mopt, struct ip6_hbh *);
   1228    1.2    itojun 		hbh->ip6h_len += (JUMBOOPTLEN >> 3);
   1229    1.2    itojun 	}
   1230    1.2    itojun 
   1231    1.2    itojun 	/* fill in the option. */
   1232    1.2    itojun 	optbuf[2] = IP6OPT_JUMBO;
   1233    1.2    itojun 	optbuf[3] = 4;
   1234   1.25    itojun 	v = (u_int32_t)htonl(plen + JUMBOOPTLEN);
   1235   1.25    itojun 	bcopy(&v, &optbuf[4], sizeof(u_int32_t));
   1236    1.2    itojun 
   1237    1.2    itojun 	/* finally, adjust the packet header length */
   1238    1.2    itojun 	exthdrs->ip6e_ip6->m_pkthdr.len += JUMBOOPTLEN;
   1239    1.2    itojun 
   1240   1.57    itojun 	return (0);
   1241    1.2    itojun #undef JUMBOOPTLEN
   1242    1.2    itojun }
   1243    1.2    itojun 
   1244    1.2    itojun /*
   1245    1.2    itojun  * Insert fragment header and copy unfragmentable header portions.
   1246  1.197      maxv  *
   1247  1.150       gdt  * *frghdrp will not be read, and it is guaranteed that either an
   1248  1.150       gdt  * error is returned or that *frghdrp will point to space allocated
   1249  1.150       gdt  * for the fragment header.
   1250  1.197      maxv  *
   1251  1.197      maxv  * On entry, m contains:
   1252  1.197      maxv  *     IPv6 Header
   1253  1.197      maxv  * On exit, it contains:
   1254  1.197      maxv  *     IPv6 Header -> Unfragmentable Part -> Frag6 Header
   1255    1.2    itojun  */
   1256    1.2    itojun static int
   1257  1.197      maxv ip6_insertfraghdr(struct mbuf *m0, struct mbuf *m, int hlen,
   1258  1.119  christos 	struct ip6_frag **frghdrp)
   1259    1.2    itojun {
   1260    1.2    itojun 	struct mbuf *n, *mlast;
   1261    1.2    itojun 
   1262    1.2    itojun 	if (hlen > sizeof(struct ip6_hdr)) {
   1263    1.2    itojun 		n = m_copym(m0, sizeof(struct ip6_hdr),
   1264   1.49    itojun 		    hlen - sizeof(struct ip6_hdr), M_DONTWAIT);
   1265  1.197      maxv 		if (n == NULL)
   1266  1.197      maxv 			return ENOBUFS;
   1267    1.2    itojun 		m->m_next = n;
   1268   1.19    itojun 	} else
   1269    1.2    itojun 		n = m;
   1270    1.2    itojun 
   1271    1.2    itojun 	/* Search for the last mbuf of unfragmentable part. */
   1272    1.2    itojun 	for (mlast = n; mlast->m_next; mlast = mlast->m_next)
   1273    1.2    itojun 		;
   1274    1.2    itojun 
   1275    1.2    itojun 	if ((mlast->m_flags & M_EXT) == 0 &&
   1276   1.22    itojun 	    M_TRAILINGSPACE(mlast) >= sizeof(struct ip6_frag)) {
   1277    1.2    itojun 		/* use the trailing space of the last mbuf for the fragment hdr */
   1278  1.117  christos 		*frghdrp = (struct ip6_frag *)(mtod(mlast, char *) +
   1279   1.49    itojun 		    mlast->m_len);
   1280    1.2    itojun 		mlast->m_len += sizeof(struct ip6_frag);
   1281    1.2    itojun 		m->m_pkthdr.len += sizeof(struct ip6_frag);
   1282   1.19    itojun 	} else {
   1283    1.2    itojun 		/* allocate a new mbuf for the fragment header */
   1284    1.2    itojun 		struct mbuf *mfrg;
   1285    1.2    itojun 
   1286    1.2    itojun 		MGET(mfrg, M_DONTWAIT, MT_DATA);
   1287  1.197      maxv 		if (mfrg == NULL)
   1288  1.197      maxv 			return ENOBUFS;
   1289    1.2    itojun 		mfrg->m_len = sizeof(struct ip6_frag);
   1290    1.2    itojun 		*frghdrp = mtod(mfrg, struct ip6_frag *);
   1291    1.2    itojun 		mlast->m_next = mfrg;
   1292    1.2    itojun 	}
   1293    1.2    itojun 
   1294  1.197      maxv 	return 0;
   1295   1.45    itojun }
   1296   1.45    itojun 
   1297   1.88    itojun static int
   1298  1.176     ozaki ip6_getpmtu(struct rtentry *rt, struct ifnet *ifp, u_long *mtup,
   1299  1.176     ozaki     int *alwaysfragp)
   1300   1.45    itojun {
   1301   1.45    itojun 	u_int32_t mtu = 0;
   1302   1.78    itojun 	int alwaysfrag = 0;
   1303   1.45    itojun 	int error = 0;
   1304   1.45    itojun 
   1305  1.126    dyoung 	if (rt != NULL) {
   1306   1.45    itojun 		u_int32_t ifmtu;
   1307   1.45    itojun 
   1308   1.45    itojun 		if (ifp == NULL)
   1309  1.124    dyoung 			ifp = rt->rt_ifp;
   1310   1.45    itojun 		ifmtu = IN6_LINKMTU(ifp);
   1311  1.124    dyoung 		mtu = rt->rt_rmx.rmx_mtu;
   1312   1.46    itojun 		if (mtu == 0)
   1313   1.46    itojun 			mtu = ifmtu;
   1314   1.78    itojun 		else if (mtu < IPV6_MMTU) {
   1315   1.78    itojun 			/*
   1316   1.78    itojun 			 * RFC2460 section 5, last paragraph:
   1317   1.78    itojun 			 * if we record ICMPv6 too big message with
   1318   1.78    itojun 			 * mtu < IPV6_MMTU, transmit packets sized IPV6_MMTU
   1319   1.78    itojun 			 * or smaller, with fragment header attached.
   1320   1.78    itojun 			 * (fragment header is needed regardless from the
   1321   1.78    itojun 			 * packet size, for translators to identify packets)
   1322   1.78    itojun 			 */
   1323   1.78    itojun 			alwaysfrag = 1;
   1324   1.78    itojun 			mtu = IPV6_MMTU;
   1325   1.78    itojun 		} else if (mtu > ifmtu) {
   1326   1.45    itojun 			/*
   1327   1.45    itojun 			 * The MTU on the route is larger than the MTU on
   1328   1.45    itojun 			 * the interface!  This shouldn't happen, unless the
   1329   1.45    itojun 			 * MTU of the interface has been changed after the
   1330   1.45    itojun 			 * interface was brought up.  Change the MTU in the
   1331   1.45    itojun 			 * route to match the interface MTU (as long as the
   1332   1.45    itojun 			 * field isn't locked).
   1333   1.45    itojun 			 */
   1334   1.45    itojun 			mtu = ifmtu;
   1335  1.124    dyoung 			if (!(rt->rt_rmx.rmx_locks & RTV_MTU))
   1336  1.124    dyoung 				rt->rt_rmx.rmx_mtu = mtu;
   1337   1.45    itojun 		}
   1338   1.45    itojun 	} else if (ifp) {
   1339   1.45    itojun 		mtu = IN6_LINKMTU(ifp);
   1340   1.45    itojun 	} else
   1341   1.45    itojun 		error = EHOSTUNREACH; /* XXX */
   1342   1.45    itojun 
   1343   1.45    itojun 	*mtup = mtu;
   1344   1.78    itojun 	if (alwaysfragp)
   1345   1.78    itojun 		*alwaysfragp = alwaysfrag;
   1346   1.57    itojun 	return (error);
   1347    1.2    itojun }
   1348    1.2    itojun 
   1349    1.2    itojun /*
   1350    1.2    itojun  * IP6 socket option processing.
   1351    1.2    itojun  */
   1352    1.2    itojun int
   1353  1.130    plunky ip6_ctloutput(int op, struct socket *so, struct sockopt *sopt)
   1354    1.2    itojun {
   1355  1.138      elad 	int optdatalen, uproto;
   1356   1.97    rpaulo 	void *optdata;
   1357   1.31    itojun 	struct in6pcb *in6p = sotoin6pcb(so);
   1358  1.159  christos 	struct ip_moptions **mopts;
   1359   1.97    rpaulo 	int error, optval;
   1360  1.130    plunky 	int level, optname;
   1361  1.130    plunky 
   1362  1.185     ozaki 	KASSERT(solocked(so));
   1363  1.130    plunky 	KASSERT(sopt != NULL);
   1364  1.130    plunky 
   1365  1.130    plunky 	level = sopt->sopt_level;
   1366  1.130    plunky 	optname = sopt->sopt_name;
   1367    1.2    itojun 
   1368   1.97    rpaulo 	error = optval = 0;
   1369   1.97    rpaulo 	uproto = (int)so->so_proto->pr_protocol;
   1370   1.97    rpaulo 
   1371  1.159  christos 	switch (level) {
   1372  1.159  christos 	case IPPROTO_IP:
   1373  1.159  christos 		switch (optname) {
   1374  1.159  christos 		case IP_ADD_MEMBERSHIP:
   1375  1.159  christos 		case IP_DROP_MEMBERSHIP:
   1376  1.159  christos 		case IP_MULTICAST_IF:
   1377  1.159  christos 		case IP_MULTICAST_LOOP:
   1378  1.159  christos 		case IP_MULTICAST_TTL:
   1379  1.159  christos 			mopts = &in6p->in6p_v4moptions;
   1380  1.159  christos 			switch (op) {
   1381  1.159  christos 			case PRCO_GETOPT:
   1382  1.159  christos 				return ip_getmoptions(*mopts, sopt);
   1383  1.159  christos 			case PRCO_SETOPT:
   1384  1.159  christos 				return ip_setmoptions(mopts, sopt);
   1385  1.159  christos 			default:
   1386  1.159  christos 				return EINVAL;
   1387  1.159  christos 			}
   1388  1.159  christos 		default:
   1389  1.159  christos 			return ENOPROTOOPT;
   1390  1.159  christos 		}
   1391  1.159  christos 	case IPPROTO_IPV6:
   1392  1.159  christos 		break;
   1393  1.159  christos 	default:
   1394  1.121    dyoung 		return ENOPROTOOPT;
   1395  1.121    dyoung 	}
   1396  1.121    dyoung 	switch (op) {
   1397  1.121    dyoung 	case PRCO_SETOPT:
   1398  1.121    dyoung 		switch (optname) {
   1399   1.97    rpaulo #ifdef RFC2292
   1400  1.121    dyoung 		case IPV6_2292PKTOPTIONS:
   1401  1.130    plunky 			error = ip6_pcbopts(&in6p->in6p_outputopts, so, sopt);
   1402  1.121    dyoung 			break;
   1403  1.121    dyoung #endif
   1404  1.121    dyoung 
   1405  1.121    dyoung 		/*
   1406  1.121    dyoung 		 * Use of some Hop-by-Hop options or some
   1407  1.121    dyoung 		 * Destination options, might require special
   1408  1.121    dyoung 		 * privilege.  That is, normal applications
   1409  1.121    dyoung 		 * (without special privilege) might be forbidden
   1410  1.121    dyoung 		 * from setting certain options in outgoing packets,
   1411  1.121    dyoung 		 * and might never see certain options in received
   1412  1.121    dyoung 		 * packets. [RFC 2292 Section 6]
   1413  1.121    dyoung 		 * KAME specific note:
   1414  1.121    dyoung 		 *  KAME prevents non-privileged users from sending or
   1415  1.121    dyoung 		 *  receiving ANY hbh/dst options in order to avoid
   1416  1.121    dyoung 		 *  overhead of parsing options in the kernel.
   1417  1.121    dyoung 		 */
   1418  1.121    dyoung 		case IPV6_RECVHOPOPTS:
   1419  1.121    dyoung 		case IPV6_RECVDSTOPTS:
   1420  1.121    dyoung 		case IPV6_RECVRTHDRDSTOPTS:
   1421  1.146      elad 			error = kauth_authorize_network(kauth_cred_get(),
   1422  1.146      elad 			    KAUTH_NETWORK_IPV6, KAUTH_REQ_NETWORK_IPV6_HOPBYHOP,
   1423  1.146      elad 			    NULL, NULL, NULL);
   1424  1.138      elad 			if (error)
   1425  1.121    dyoung 				break;
   1426  1.121    dyoung 			/* FALLTHROUGH */
   1427  1.121    dyoung 		case IPV6_UNICAST_HOPS:
   1428  1.121    dyoung 		case IPV6_HOPLIMIT:
   1429  1.121    dyoung 		case IPV6_FAITH:
   1430  1.121    dyoung 
   1431  1.121    dyoung 		case IPV6_RECVPKTINFO:
   1432  1.121    dyoung 		case IPV6_RECVHOPLIMIT:
   1433  1.121    dyoung 		case IPV6_RECVRTHDR:
   1434  1.121    dyoung 		case IPV6_RECVPATHMTU:
   1435  1.121    dyoung 		case IPV6_RECVTCLASS:
   1436  1.121    dyoung 		case IPV6_V6ONLY:
   1437  1.130    plunky 			error = sockopt_getint(sopt, &optval);
   1438  1.130    plunky 			if (error)
   1439   1.97    rpaulo 				break;
   1440  1.121    dyoung 			switch (optname) {
   1441    1.2    itojun 			case IPV6_UNICAST_HOPS:
   1442  1.121    dyoung 				if (optval < -1 || optval >= 256)
   1443    1.2    itojun 					error = EINVAL;
   1444  1.121    dyoung 				else {
   1445  1.121    dyoung 					/* -1 = kernel default */
   1446  1.121    dyoung 					in6p->in6p_hops = optval;
   1447   1.37    itojun 				}
   1448  1.121    dyoung 				break;
   1449    1.2    itojun #define OPTSET(bit) \
   1450   1.49    itojun do { \
   1451  1.121    dyoung if (optval) \
   1452  1.121    dyoung 	in6p->in6p_flags |= (bit); \
   1453  1.121    dyoung else \
   1454  1.121    dyoung 	in6p->in6p_flags &= ~(bit); \
   1455   1.60     perry } while (/*CONSTCOND*/ 0)
   1456    1.2    itojun 
   1457   1.97    rpaulo #ifdef RFC2292
   1458   1.97    rpaulo #define OPTSET2292(bit) 			\
   1459   1.97    rpaulo do { 						\
   1460  1.121    dyoung in6p->in6p_flags |= IN6P_RFC2292; 	\
   1461  1.121    dyoung if (optval) 				\
   1462  1.121    dyoung 	in6p->in6p_flags |= (bit); 	\
   1463  1.121    dyoung else 					\
   1464  1.121    dyoung 	in6p->in6p_flags &= ~(bit); 	\
   1465   1.97    rpaulo } while (/*CONSTCOND*/ 0)
   1466   1.97    rpaulo #endif
   1467   1.97    rpaulo 
   1468   1.97    rpaulo #define OPTBIT(bit) (in6p->in6p_flags & (bit) ? 1 : 0)
   1469    1.2    itojun 
   1470  1.121    dyoung 			case IPV6_RECVPKTINFO:
   1471   1.97    rpaulo #ifdef RFC2292
   1472  1.121    dyoung 				/* cannot mix with RFC2292 */
   1473  1.121    dyoung 				if (OPTBIT(IN6P_RFC2292)) {
   1474  1.121    dyoung 					error = EINVAL;
   1475  1.121    dyoung 					break;
   1476  1.121    dyoung 				}
   1477   1.97    rpaulo #endif
   1478  1.121    dyoung 				OPTSET(IN6P_PKTINFO);
   1479  1.121    dyoung 				break;
   1480  1.121    dyoung 
   1481  1.121    dyoung 			case IPV6_HOPLIMIT:
   1482  1.121    dyoung 			{
   1483  1.121    dyoung 				struct ip6_pktopts **optp;
   1484    1.2    itojun 
   1485  1.121    dyoung #ifdef RFC2292
   1486  1.121    dyoung 				/* cannot mix with RFC2292 */
   1487  1.121    dyoung 				if (OPTBIT(IN6P_RFC2292)) {
   1488  1.121    dyoung 					error = EINVAL;
   1489   1.37    itojun 					break;
   1490   1.97    rpaulo 				}
   1491  1.121    dyoung #endif
   1492  1.121    dyoung 				optp = &in6p->in6p_outputopts;
   1493  1.121    dyoung 				error = ip6_pcbopt(IPV6_HOPLIMIT,
   1494  1.121    dyoung 						   (u_char *)&optval,
   1495  1.121    dyoung 						   sizeof(optval),
   1496  1.121    dyoung 						   optp,
   1497  1.138      elad 						   kauth_cred_get(), uproto);
   1498  1.121    dyoung 				break;
   1499  1.121    dyoung 			}
   1500    1.2    itojun 
   1501  1.121    dyoung 			case IPV6_RECVHOPLIMIT:
   1502   1.97    rpaulo #ifdef RFC2292
   1503  1.121    dyoung 				/* cannot mix with RFC2292 */
   1504  1.121    dyoung 				if (OPTBIT(IN6P_RFC2292)) {
   1505  1.121    dyoung 					error = EINVAL;
   1506  1.121    dyoung 					break;
   1507  1.121    dyoung 				}
   1508   1.97    rpaulo #endif
   1509  1.121    dyoung 				OPTSET(IN6P_HOPLIMIT);
   1510  1.121    dyoung 				break;
   1511    1.2    itojun 
   1512  1.121    dyoung 			case IPV6_RECVHOPOPTS:
   1513   1.97    rpaulo #ifdef RFC2292
   1514  1.121    dyoung 				/* cannot mix with RFC2292 */
   1515  1.121    dyoung 				if (OPTBIT(IN6P_RFC2292)) {
   1516  1.121    dyoung 					error = EINVAL;
   1517  1.121    dyoung 					break;
   1518  1.121    dyoung 				}
   1519   1.97    rpaulo #endif
   1520  1.121    dyoung 				OPTSET(IN6P_HOPOPTS);
   1521  1.121    dyoung 				break;
   1522    1.2    itojun 
   1523  1.121    dyoung 			case IPV6_RECVDSTOPTS:
   1524   1.97    rpaulo #ifdef RFC2292
   1525  1.121    dyoung 				/* cannot mix with RFC2292 */
   1526  1.121    dyoung 				if (OPTBIT(IN6P_RFC2292)) {
   1527  1.121    dyoung 					error = EINVAL;
   1528  1.121    dyoung 					break;
   1529  1.121    dyoung 				}
   1530   1.97    rpaulo #endif
   1531  1.121    dyoung 				OPTSET(IN6P_DSTOPTS);
   1532  1.121    dyoung 				break;
   1533    1.2    itojun 
   1534  1.121    dyoung 			case IPV6_RECVRTHDRDSTOPTS:
   1535   1.97    rpaulo #ifdef RFC2292
   1536  1.121    dyoung 				/* cannot mix with RFC2292 */
   1537  1.121    dyoung 				if (OPTBIT(IN6P_RFC2292)) {
   1538  1.121    dyoung 					error = EINVAL;
   1539  1.121    dyoung 					break;
   1540  1.121    dyoung 				}
   1541   1.97    rpaulo #endif
   1542  1.121    dyoung 				OPTSET(IN6P_RTHDRDSTOPTS);
   1543  1.121    dyoung 				break;
   1544   1.97    rpaulo 
   1545  1.121    dyoung 			case IPV6_RECVRTHDR:
   1546   1.97    rpaulo #ifdef RFC2292
   1547  1.121    dyoung 				/* cannot mix with RFC2292 */
   1548  1.121    dyoung 				if (OPTBIT(IN6P_RFC2292)) {
   1549  1.121    dyoung 					error = EINVAL;
   1550  1.121    dyoung 					break;
   1551  1.121    dyoung 				}
   1552   1.97    rpaulo #endif
   1553  1.121    dyoung 				OPTSET(IN6P_RTHDR);
   1554  1.121    dyoung 				break;
   1555  1.121    dyoung 
   1556  1.121    dyoung 			case IPV6_FAITH:
   1557  1.121    dyoung 				OPTSET(IN6P_FAITH);
   1558  1.121    dyoung 				break;
   1559    1.2    itojun 
   1560  1.121    dyoung 			case IPV6_RECVPATHMTU:
   1561  1.121    dyoung 				/*
   1562  1.121    dyoung 				 * We ignore this option for TCP
   1563  1.121    dyoung 				 * sockets.
   1564  1.121    dyoung 				 * (RFC3542 leaves this case
   1565  1.121    dyoung 				 * unspecified.)
   1566  1.121    dyoung 				 */
   1567  1.121    dyoung 				if (uproto != IPPROTO_TCP)
   1568  1.121    dyoung 					OPTSET(IN6P_MTU);
   1569  1.121    dyoung 				break;
   1570   1.10    itojun 
   1571  1.121    dyoung 			case IPV6_V6ONLY:
   1572  1.121    dyoung 				/*
   1573  1.121    dyoung 				 * make setsockopt(IPV6_V6ONLY)
   1574  1.121    dyoung 				 * available only prior to bind(2).
   1575  1.121    dyoung 				 * see ipng mailing list, Jun 22 2001.
   1576  1.121    dyoung 				 */
   1577  1.121    dyoung 				if (in6p->in6p_lport ||
   1578  1.121    dyoung 				    !IN6_IS_ADDR_UNSPECIFIED(&in6p->in6p_laddr)) {
   1579  1.121    dyoung 					error = EINVAL;
   1580   1.83    itojun 					break;
   1581  1.121    dyoung 				}
   1582   1.37    itojun #ifdef INET6_BINDV6ONLY
   1583  1.121    dyoung 				if (!optval)
   1584  1.121    dyoung 					error = EINVAL;
   1585   1.37    itojun #else
   1586  1.121    dyoung 				OPTSET(IN6P_IPV6_V6ONLY);
   1587   1.10    itojun #endif
   1588  1.121    dyoung 				break;
   1589  1.121    dyoung 			case IPV6_RECVTCLASS:
   1590  1.121    dyoung #ifdef RFC2292
   1591  1.121    dyoung 				/* cannot mix with RFC2292 XXX */
   1592  1.121    dyoung 				if (OPTBIT(IN6P_RFC2292)) {
   1593  1.121    dyoung 					error = EINVAL;
   1594   1.37    itojun 					break;
   1595  1.121    dyoung 				}
   1596   1.97    rpaulo #endif
   1597  1.121    dyoung 				OPTSET(IN6P_TCLASS);
   1598  1.121    dyoung 				break;
   1599  1.121    dyoung 
   1600  1.121    dyoung 			}
   1601  1.121    dyoung 			break;
   1602  1.121    dyoung 
   1603  1.121    dyoung 		case IPV6_OTCLASS:
   1604  1.121    dyoung 		{
   1605  1.121    dyoung 			struct ip6_pktopts **optp;
   1606  1.121    dyoung 			u_int8_t tclass;
   1607   1.97    rpaulo 
   1608  1.130    plunky 			error = sockopt_get(sopt, &tclass, sizeof(tclass));
   1609  1.130    plunky 			if (error)
   1610   1.97    rpaulo 				break;
   1611  1.121    dyoung 			optp = &in6p->in6p_outputopts;
   1612  1.121    dyoung 			error = ip6_pcbopt(optname,
   1613  1.121    dyoung 					   (u_char *)&tclass,
   1614  1.121    dyoung 					   sizeof(tclass),
   1615  1.121    dyoung 					   optp,
   1616  1.138      elad 					   kauth_cred_get(), uproto);
   1617  1.121    dyoung 			break;
   1618  1.121    dyoung 		}
   1619   1.97    rpaulo 
   1620  1.121    dyoung 		case IPV6_TCLASS:
   1621  1.121    dyoung 		case IPV6_DONTFRAG:
   1622  1.121    dyoung 		case IPV6_USE_MIN_MTU:
   1623  1.161       roy 		case IPV6_PREFER_TEMPADDR:
   1624  1.130    plunky 			error = sockopt_getint(sopt, &optval);
   1625  1.130    plunky 			if (error)
   1626  1.121    dyoung 				break;
   1627   1.97    rpaulo 			{
   1628   1.97    rpaulo 				struct ip6_pktopts **optp;
   1629   1.97    rpaulo 				optp = &in6p->in6p_outputopts;
   1630   1.97    rpaulo 				error = ip6_pcbopt(optname,
   1631  1.121    dyoung 						   (u_char *)&optval,
   1632  1.121    dyoung 						   sizeof(optval),
   1633   1.97    rpaulo 						   optp,
   1634  1.138      elad 						   kauth_cred_get(), uproto);
   1635   1.97    rpaulo 				break;
   1636   1.97    rpaulo 			}
   1637   1.97    rpaulo 
   1638   1.97    rpaulo #ifdef RFC2292
   1639  1.121    dyoung 		case IPV6_2292PKTINFO:
   1640  1.121    dyoung 		case IPV6_2292HOPLIMIT:
   1641  1.121    dyoung 		case IPV6_2292HOPOPTS:
   1642  1.121    dyoung 		case IPV6_2292DSTOPTS:
   1643  1.121    dyoung 		case IPV6_2292RTHDR:
   1644  1.121    dyoung 			/* RFC 2292 */
   1645  1.130    plunky 			error = sockopt_getint(sopt, &optval);
   1646  1.130    plunky 			if (error)
   1647  1.121    dyoung 				break;
   1648  1.130    plunky 
   1649  1.121    dyoung 			switch (optname) {
   1650   1.97    rpaulo 			case IPV6_2292PKTINFO:
   1651  1.121    dyoung 				OPTSET2292(IN6P_PKTINFO);
   1652  1.121    dyoung 				break;
   1653   1.97    rpaulo 			case IPV6_2292HOPLIMIT:
   1654  1.121    dyoung 				OPTSET2292(IN6P_HOPLIMIT);
   1655  1.121    dyoung 				break;
   1656   1.97    rpaulo 			case IPV6_2292HOPOPTS:
   1657  1.121    dyoung 				/*
   1658  1.121    dyoung 				 * Check super-user privilege.
   1659  1.121    dyoung 				 * See comments for IPV6_RECVHOPOPTS.
   1660  1.121    dyoung 				 */
   1661  1.138      elad 				error =
   1662  1.146      elad 				    kauth_authorize_network(kauth_cred_get(),
   1663  1.146      elad 				    KAUTH_NETWORK_IPV6,
   1664  1.146      elad 				    KAUTH_REQ_NETWORK_IPV6_HOPBYHOP, NULL,
   1665  1.146      elad 				    NULL, NULL);
   1666  1.138      elad 				if (error)
   1667  1.138      elad 					return (error);
   1668  1.121    dyoung 				OPTSET2292(IN6P_HOPOPTS);
   1669  1.121    dyoung 				break;
   1670   1.97    rpaulo 			case IPV6_2292DSTOPTS:
   1671  1.138      elad 				error =
   1672  1.146      elad 				    kauth_authorize_network(kauth_cred_get(),
   1673  1.146      elad 				    KAUTH_NETWORK_IPV6,
   1674  1.146      elad 				    KAUTH_REQ_NETWORK_IPV6_HOPBYHOP, NULL,
   1675  1.146      elad 				    NULL, NULL);
   1676  1.138      elad 				if (error)
   1677  1.138      elad 					return (error);
   1678  1.121    dyoung 				OPTSET2292(IN6P_DSTOPTS|IN6P_RTHDRDSTOPTS); /* XXX */
   1679  1.121    dyoung 				break;
   1680   1.97    rpaulo 			case IPV6_2292RTHDR:
   1681  1.121    dyoung 				OPTSET2292(IN6P_RTHDR);
   1682   1.97    rpaulo 				break;
   1683  1.121    dyoung 			}
   1684  1.121    dyoung 			break;
   1685   1.97    rpaulo #endif
   1686  1.121    dyoung 		case IPV6_PKTINFO:
   1687  1.121    dyoung 		case IPV6_HOPOPTS:
   1688  1.121    dyoung 		case IPV6_RTHDR:
   1689  1.121    dyoung 		case IPV6_DSTOPTS:
   1690  1.121    dyoung 		case IPV6_RTHDRDSTOPTS:
   1691  1.130    plunky 		case IPV6_NEXTHOP: {
   1692  1.121    dyoung 			/* new advanced API (RFC3542) */
   1693  1.130    plunky 			void *optbuf;
   1694  1.121    dyoung 			int optbuflen;
   1695  1.121    dyoung 			struct ip6_pktopts **optp;
   1696   1.97    rpaulo 
   1697   1.97    rpaulo #ifdef RFC2292
   1698  1.121    dyoung 			/* cannot mix with RFC2292 */
   1699  1.121    dyoung 			if (OPTBIT(IN6P_RFC2292)) {
   1700  1.121    dyoung 				error = EINVAL;
   1701  1.121    dyoung 				break;
   1702  1.121    dyoung 			}
   1703   1.97    rpaulo #endif
   1704   1.97    rpaulo 
   1705  1.131    plunky 			optbuflen = sopt->sopt_size;
   1706  1.131    plunky 			optbuf = malloc(optbuflen, M_IP6OPT, M_NOWAIT);
   1707  1.131    plunky 			if (optbuf == NULL) {
   1708  1.131    plunky 				error = ENOBUFS;
   1709  1.131    plunky 				break;
   1710  1.131    plunky 			}
   1711  1.131    plunky 
   1712  1.155  christos 			error = sockopt_get(sopt, optbuf, optbuflen);
   1713  1.155  christos 			if (error) {
   1714  1.155  christos 				free(optbuf, M_IP6OPT);
   1715  1.155  christos 				break;
   1716  1.155  christos 			}
   1717  1.121    dyoung 			optp = &in6p->in6p_outputopts;
   1718  1.121    dyoung 			error = ip6_pcbopt(optname, optbuf, optbuflen,
   1719  1.138      elad 			    optp, kauth_cred_get(), uproto);
   1720  1.158      maxv 
   1721  1.158      maxv 			free(optbuf, M_IP6OPT);
   1722  1.121    dyoung 			break;
   1723  1.130    plunky 			}
   1724    1.2    itojun #undef OPTSET
   1725    1.2    itojun 
   1726  1.121    dyoung 		case IPV6_MULTICAST_IF:
   1727  1.121    dyoung 		case IPV6_MULTICAST_HOPS:
   1728  1.121    dyoung 		case IPV6_MULTICAST_LOOP:
   1729  1.121    dyoung 		case IPV6_JOIN_GROUP:
   1730  1.132    plunky 		case IPV6_LEAVE_GROUP:
   1731  1.160  christos 			error = ip6_setmoptions(sopt, in6p);
   1732  1.121    dyoung 			break;
   1733  1.121    dyoung 
   1734  1.121    dyoung 		case IPV6_PORTRANGE:
   1735  1.130    plunky 			error = sockopt_getint(sopt, &optval);
   1736  1.130    plunky 			if (error)
   1737    1.2    itojun 				break;
   1738    1.2    itojun 
   1739  1.121    dyoung 			switch (optval) {
   1740  1.121    dyoung 			case IPV6_PORTRANGE_DEFAULT:
   1741  1.121    dyoung 				in6p->in6p_flags &= ~(IN6P_LOWPORT);
   1742  1.121    dyoung 				in6p->in6p_flags &= ~(IN6P_HIGHPORT);
   1743  1.121    dyoung 				break;
   1744   1.12    itojun 
   1745  1.121    dyoung 			case IPV6_PORTRANGE_HIGH:
   1746  1.121    dyoung 				in6p->in6p_flags &= ~(IN6P_LOWPORT);
   1747  1.121    dyoung 				in6p->in6p_flags |= IN6P_HIGHPORT;
   1748  1.121    dyoung 				break;
   1749   1.12    itojun 
   1750  1.121    dyoung 			case IPV6_PORTRANGE_LOW:
   1751  1.121    dyoung 				in6p->in6p_flags &= ~(IN6P_HIGHPORT);
   1752  1.121    dyoung 				in6p->in6p_flags |= IN6P_LOWPORT;
   1753  1.121    dyoung 				break;
   1754   1.12    itojun 
   1755  1.121    dyoung 			default:
   1756  1.121    dyoung 				error = EINVAL;
   1757   1.12    itojun 				break;
   1758  1.121    dyoung 			}
   1759  1.121    dyoung 			break;
   1760   1.12    itojun 
   1761  1.148  christos 		case IPV6_PORTALGO:
   1762  1.148  christos 			error = sockopt_getint(sopt, &optval);
   1763  1.148  christos 			if (error)
   1764  1.148  christos 				break;
   1765  1.148  christos 
   1766  1.149  christos 			error = portalgo_algo_index_select(
   1767  1.148  christos 			    (struct inpcb_hdr *)in6p, optval);
   1768  1.148  christos 			break;
   1769  1.114  degroote 
   1770  1.153  christos #if defined(IPSEC)
   1771  1.121    dyoung 		case IPV6_IPSEC_POLICY:
   1772  1.157  christos 			if (ipsec_enabled) {
   1773  1.157  christos 				error = ipsec6_set_policy(in6p, optname,
   1774  1.157  christos 				    sopt->sopt_data, sopt->sopt_size,
   1775  1.157  christos 				    kauth_cred_get());
   1776  1.157  christos 				break;
   1777  1.157  christos 			}
   1778  1.157  christos 			/*FALLTHROUGH*/
   1779    1.2    itojun #endif /* IPSEC */
   1780    1.2    itojun 
   1781  1.121    dyoung 		default:
   1782  1.121    dyoung 			error = ENOPROTOOPT;
   1783    1.2    itojun 			break;
   1784  1.121    dyoung 		}
   1785  1.121    dyoung 		break;
   1786    1.2    itojun 
   1787  1.121    dyoung 	case PRCO_GETOPT:
   1788  1.121    dyoung 		switch (optname) {
   1789   1.97    rpaulo #ifdef RFC2292
   1790  1.121    dyoung 		case IPV6_2292PKTOPTIONS:
   1791  1.121    dyoung 			/*
   1792  1.121    dyoung 			 * RFC3542 (effectively) deprecated the
   1793  1.121    dyoung 			 * semantics of the 2292-style pktoptions.
   1794  1.121    dyoung 			 * Since it was not reliable in nature (i.e.,
   1795  1.121    dyoung 			 * applications had to expect the lack of some
   1796  1.121    dyoung 			 * information after all), it would make sense
   1797  1.121    dyoung 			 * to simplify this part by always returning
   1798  1.121    dyoung 			 * empty data.
   1799  1.121    dyoung 			 */
   1800  1.121    dyoung 			break;
   1801   1.97    rpaulo #endif
   1802    1.2    itojun 
   1803  1.121    dyoung 		case IPV6_RECVHOPOPTS:
   1804  1.121    dyoung 		case IPV6_RECVDSTOPTS:
   1805  1.121    dyoung 		case IPV6_RECVRTHDRDSTOPTS:
   1806  1.121    dyoung 		case IPV6_UNICAST_HOPS:
   1807  1.121    dyoung 		case IPV6_RECVPKTINFO:
   1808  1.121    dyoung 		case IPV6_RECVHOPLIMIT:
   1809  1.121    dyoung 		case IPV6_RECVRTHDR:
   1810  1.121    dyoung 		case IPV6_RECVPATHMTU:
   1811  1.121    dyoung 
   1812  1.121    dyoung 		case IPV6_FAITH:
   1813  1.121    dyoung 		case IPV6_V6ONLY:
   1814  1.121    dyoung 		case IPV6_PORTRANGE:
   1815  1.121    dyoung 		case IPV6_RECVTCLASS:
   1816  1.121    dyoung 			switch (optname) {
   1817  1.121    dyoung 
   1818   1.97    rpaulo 			case IPV6_RECVHOPOPTS:
   1819  1.121    dyoung 				optval = OPTBIT(IN6P_HOPOPTS);
   1820  1.121    dyoung 				break;
   1821  1.121    dyoung 
   1822   1.97    rpaulo 			case IPV6_RECVDSTOPTS:
   1823  1.121    dyoung 				optval = OPTBIT(IN6P_DSTOPTS);
   1824  1.121    dyoung 				break;
   1825  1.121    dyoung 
   1826   1.97    rpaulo 			case IPV6_RECVRTHDRDSTOPTS:
   1827  1.121    dyoung 				optval = OPTBIT(IN6P_RTHDRDSTOPTS);
   1828  1.121    dyoung 				break;
   1829  1.121    dyoung 
   1830   1.97    rpaulo 			case IPV6_UNICAST_HOPS:
   1831  1.121    dyoung 				optval = in6p->in6p_hops;
   1832  1.121    dyoung 				break;
   1833  1.121    dyoung 
   1834   1.97    rpaulo 			case IPV6_RECVPKTINFO:
   1835  1.121    dyoung 				optval = OPTBIT(IN6P_PKTINFO);
   1836  1.121    dyoung 				break;
   1837  1.121    dyoung 
   1838   1.97    rpaulo 			case IPV6_RECVHOPLIMIT:
   1839  1.121    dyoung 				optval = OPTBIT(IN6P_HOPLIMIT);
   1840  1.121    dyoung 				break;
   1841  1.121    dyoung 
   1842   1.97    rpaulo 			case IPV6_RECVRTHDR:
   1843  1.121    dyoung 				optval = OPTBIT(IN6P_RTHDR);
   1844  1.121    dyoung 				break;
   1845  1.121    dyoung 
   1846   1.97    rpaulo 			case IPV6_RECVPATHMTU:
   1847  1.121    dyoung 				optval = OPTBIT(IN6P_MTU);
   1848  1.121    dyoung 				break;
   1849    1.2    itojun 
   1850    1.2    itojun 			case IPV6_FAITH:
   1851  1.121    dyoung 				optval = OPTBIT(IN6P_FAITH);
   1852  1.121    dyoung 				break;
   1853  1.121    dyoung 
   1854   1.37    itojun 			case IPV6_V6ONLY:
   1855  1.121    dyoung 				optval = OPTBIT(IN6P_IPV6_V6ONLY);
   1856  1.121    dyoung 				break;
   1857  1.121    dyoung 
   1858   1.97    rpaulo 			case IPV6_PORTRANGE:
   1859  1.121    dyoung 			    {
   1860  1.121    dyoung 				int flags;
   1861  1.121    dyoung 				flags = in6p->in6p_flags;
   1862  1.121    dyoung 				if (flags & IN6P_HIGHPORT)
   1863  1.121    dyoung 					optval = IPV6_PORTRANGE_HIGH;
   1864  1.121    dyoung 				else if (flags & IN6P_LOWPORT)
   1865  1.121    dyoung 					optval = IPV6_PORTRANGE_LOW;
   1866  1.121    dyoung 				else
   1867  1.121    dyoung 					optval = 0;
   1868  1.121    dyoung 				break;
   1869  1.121    dyoung 			    }
   1870   1.97    rpaulo 			case IPV6_RECVTCLASS:
   1871  1.121    dyoung 				optval = OPTBIT(IN6P_TCLASS);
   1872  1.121    dyoung 				break;
   1873    1.2    itojun 
   1874  1.121    dyoung 			}
   1875  1.121    dyoung 			if (error)
   1876   1.97    rpaulo 				break;
   1877  1.130    plunky 			error = sockopt_setint(sopt, optval);
   1878  1.121    dyoung 			break;
   1879   1.97    rpaulo 
   1880  1.121    dyoung 		case IPV6_PATHMTU:
   1881  1.121    dyoung 		    {
   1882  1.121    dyoung 			u_long pmtu = 0;
   1883  1.121    dyoung 			struct ip6_mtuinfo mtuinfo;
   1884  1.121    dyoung 			struct route *ro = &in6p->in6p_route;
   1885  1.176     ozaki 			struct rtentry *rt;
   1886  1.176     ozaki 			union {
   1887  1.176     ozaki 				struct sockaddr		dst;
   1888  1.176     ozaki 				struct sockaddr_in6	dst6;
   1889  1.176     ozaki 			} u;
   1890    1.2    itojun 
   1891  1.121    dyoung 			if (!(so->so_state & SS_ISCONNECTED))
   1892  1.121    dyoung 				return (ENOTCONN);
   1893  1.121    dyoung 			/*
   1894  1.121    dyoung 			 * XXX: we dot not consider the case of source
   1895  1.121    dyoung 			 * routing, or optional information to specify
   1896  1.121    dyoung 			 * the outgoing interface.
   1897  1.121    dyoung 			 */
   1898  1.176     ozaki 			sockaddr_in6_init(&u.dst6, &in6p->in6p_faddr, 0, 0, 0);
   1899  1.176     ozaki 			rt = rtcache_lookup(ro, &u.dst);
   1900  1.176     ozaki 			error = ip6_getpmtu(rt, NULL, &pmtu, NULL);
   1901  1.179     ozaki 			rtcache_unref(rt, ro);
   1902  1.121    dyoung 			if (error)
   1903  1.121    dyoung 				break;
   1904  1.121    dyoung 			if (pmtu > IPV6_MAXPACKET)
   1905  1.121    dyoung 				pmtu = IPV6_MAXPACKET;
   1906  1.121    dyoung 
   1907  1.121    dyoung 			memset(&mtuinfo, 0, sizeof(mtuinfo));
   1908  1.121    dyoung 			mtuinfo.ip6m_mtu = (u_int32_t)pmtu;
   1909  1.121    dyoung 			optdata = (void *)&mtuinfo;
   1910  1.121    dyoung 			optdatalen = sizeof(mtuinfo);
   1911  1.121    dyoung 			if (optdatalen > MCLBYTES)
   1912  1.121    dyoung 				return (EMSGSIZE); /* XXX */
   1913  1.130    plunky 			error = sockopt_set(sopt, optdata, optdatalen);
   1914  1.121    dyoung 			break;
   1915  1.121    dyoung 		    }
   1916   1.97    rpaulo 
   1917   1.97    rpaulo #ifdef RFC2292
   1918  1.121    dyoung 		case IPV6_2292PKTINFO:
   1919  1.121    dyoung 		case IPV6_2292HOPLIMIT:
   1920  1.121    dyoung 		case IPV6_2292HOPOPTS:
   1921  1.121    dyoung 		case IPV6_2292RTHDR:
   1922  1.121    dyoung 		case IPV6_2292DSTOPTS:
   1923  1.121    dyoung 			switch (optname) {
   1924   1.97    rpaulo 			case IPV6_2292PKTINFO:
   1925  1.121    dyoung 				optval = OPTBIT(IN6P_PKTINFO);
   1926  1.121    dyoung 				break;
   1927   1.97    rpaulo 			case IPV6_2292HOPLIMIT:
   1928  1.121    dyoung 				optval = OPTBIT(IN6P_HOPLIMIT);
   1929  1.121    dyoung 				break;
   1930   1.97    rpaulo 			case IPV6_2292HOPOPTS:
   1931  1.121    dyoung 				optval = OPTBIT(IN6P_HOPOPTS);
   1932  1.121    dyoung 				break;
   1933   1.97    rpaulo 			case IPV6_2292RTHDR:
   1934  1.121    dyoung 				optval = OPTBIT(IN6P_RTHDR);
   1935  1.121    dyoung 				break;
   1936   1.97    rpaulo 			case IPV6_2292DSTOPTS:
   1937  1.121    dyoung 				optval = OPTBIT(IN6P_DSTOPTS|IN6P_RTHDRDSTOPTS);
   1938    1.2    itojun 				break;
   1939  1.121    dyoung 			}
   1940  1.130    plunky 			error = sockopt_setint(sopt, optval);
   1941  1.121    dyoung 			break;
   1942  1.121    dyoung #endif
   1943  1.121    dyoung 		case IPV6_PKTINFO:
   1944  1.121    dyoung 		case IPV6_HOPOPTS:
   1945  1.121    dyoung 		case IPV6_RTHDR:
   1946  1.121    dyoung 		case IPV6_DSTOPTS:
   1947  1.121    dyoung 		case IPV6_RTHDRDSTOPTS:
   1948  1.121    dyoung 		case IPV6_NEXTHOP:
   1949  1.121    dyoung 		case IPV6_OTCLASS:
   1950  1.121    dyoung 		case IPV6_TCLASS:
   1951  1.121    dyoung 		case IPV6_DONTFRAG:
   1952  1.121    dyoung 		case IPV6_USE_MIN_MTU:
   1953  1.161       roy 		case IPV6_PREFER_TEMPADDR:
   1954  1.121    dyoung 			error = ip6_getpcbopt(in6p->in6p_outputopts,
   1955  1.130    plunky 			    optname, sopt);
   1956  1.121    dyoung 			break;
   1957  1.121    dyoung 
   1958  1.121    dyoung 		case IPV6_MULTICAST_IF:
   1959  1.121    dyoung 		case IPV6_MULTICAST_HOPS:
   1960  1.121    dyoung 		case IPV6_MULTICAST_LOOP:
   1961  1.121    dyoung 		case IPV6_JOIN_GROUP:
   1962  1.132    plunky 		case IPV6_LEAVE_GROUP:
   1963  1.160  christos 			error = ip6_getmoptions(sopt, in6p);
   1964  1.121    dyoung 			break;
   1965    1.2    itojun 
   1966  1.148  christos 		case IPV6_PORTALGO:
   1967  1.149  christos 			optval = ((struct inpcb_hdr *)in6p)->inph_portalgo;
   1968  1.148  christos 			error = sockopt_setint(sopt, optval);
   1969  1.148  christos 			break;
   1970  1.148  christos 
   1971  1.153  christos #if defined(IPSEC)
   1972  1.121    dyoung 		case IPV6_IPSEC_POLICY:
   1973  1.157  christos 			if (ipsec_used) {
   1974  1.157  christos 				struct mbuf *m = NULL;
   1975  1.130    plunky 
   1976  1.157  christos 				/*
   1977  1.157  christos 				 * XXX: this will return EINVAL as sopt is
   1978  1.157  christos 				 * empty
   1979  1.157  christos 				 */
   1980  1.157  christos 				error = ipsec6_get_policy(in6p, sopt->sopt_data,
   1981  1.157  christos 				    sopt->sopt_size, &m);
   1982  1.157  christos 				if (!error)
   1983  1.157  christos 					error = sockopt_setmbuf(sopt, m);
   1984  1.157  christos 				break;
   1985  1.157  christos 			}
   1986  1.157  christos 			/*FALLTHROUGH*/
   1987    1.2    itojun #endif /* IPSEC */
   1988    1.2    itojun 
   1989  1.121    dyoung 		default:
   1990  1.121    dyoung 			error = ENOPROTOOPT;
   1991    1.2    itojun 			break;
   1992    1.2    itojun 		}
   1993  1.121    dyoung 		break;
   1994    1.2    itojun 	}
   1995   1.57    itojun 	return (error);
   1996   1.53    itojun }
   1997   1.53    itojun 
   1998   1.53    itojun int
   1999  1.130    plunky ip6_raw_ctloutput(int op, struct socket *so, struct sockopt *sopt)
   2000   1.53    itojun {
   2001  1.130    plunky 	int error = 0, optval;
   2002   1.53    itojun 	const int icmp6off = offsetof(struct icmp6_hdr, icmp6_cksum);
   2003   1.53    itojun 	struct in6pcb *in6p = sotoin6pcb(so);
   2004  1.130    plunky 	int level, optname;
   2005   1.53    itojun 
   2006  1.130    plunky 	KASSERT(sopt != NULL);
   2007  1.130    plunky 
   2008  1.130    plunky 	level = sopt->sopt_level;
   2009  1.130    plunky 	optname = sopt->sopt_name;
   2010   1.53    itojun 
   2011   1.53    itojun 	if (level != IPPROTO_IPV6) {
   2012  1.121    dyoung 		return ENOPROTOOPT;
   2013   1.53    itojun 	}
   2014   1.55    itojun 
   2015   1.53    itojun 	switch (optname) {
   2016   1.53    itojun 	case IPV6_CHECKSUM:
   2017   1.53    itojun 		/*
   2018   1.53    itojun 		 * For ICMPv6 sockets, no modification allowed for checksum
   2019   1.53    itojun 		 * offset, permit "no change" values to help existing apps.
   2020   1.53    itojun 		 *
   2021   1.97    rpaulo 		 * XXX RFC3542 says: "An attempt to set IPV6_CHECKSUM
   2022   1.97    rpaulo 		 * for an ICMPv6 socket will fail."  The current
   2023   1.97    rpaulo 		 * behavior does not meet RFC3542.
   2024   1.53    itojun 		 */
   2025   1.53    itojun 		switch (op) {
   2026   1.53    itojun 		case PRCO_SETOPT:
   2027  1.130    plunky 			error = sockopt_getint(sopt, &optval);
   2028  1.130    plunky 			if (error)
   2029   1.53    itojun 				break;
   2030   1.53    itojun 			if ((optval % 2) != 0) {
   2031   1.53    itojun 				/* the API assumes even offset values */
   2032   1.53    itojun 				error = EINVAL;
   2033   1.53    itojun 			} else if (so->so_proto->pr_protocol ==
   2034   1.53    itojun 			    IPPROTO_ICMPV6) {
   2035   1.53    itojun 				if (optval != icmp6off)
   2036   1.53    itojun 					error = EINVAL;
   2037   1.53    itojun 			} else
   2038   1.53    itojun 				in6p->in6p_cksum = optval;
   2039   1.53    itojun 			break;
   2040   1.53    itojun 
   2041   1.53    itojun 		case PRCO_GETOPT:
   2042   1.53    itojun 			if (so->so_proto->pr_protocol == IPPROTO_ICMPV6)
   2043   1.53    itojun 				optval = icmp6off;
   2044   1.53    itojun 			else
   2045   1.53    itojun 				optval = in6p->in6p_cksum;
   2046   1.53    itojun 
   2047  1.130    plunky 			error = sockopt_setint(sopt, optval);
   2048   1.53    itojun 			break;
   2049   1.53    itojun 
   2050   1.53    itojun 		default:
   2051   1.53    itojun 			error = EINVAL;
   2052   1.53    itojun 			break;
   2053   1.53    itojun 		}
   2054   1.53    itojun 		break;
   2055   1.53    itojun 
   2056   1.53    itojun 	default:
   2057   1.53    itojun 		error = ENOPROTOOPT;
   2058   1.53    itojun 		break;
   2059   1.53    itojun 	}
   2060   1.53    itojun 
   2061   1.57    itojun 	return (error);
   2062    1.2    itojun }
   2063    1.2    itojun 
   2064   1.97    rpaulo #ifdef RFC2292
   2065    1.2    itojun /*
   2066   1.97    rpaulo  * Set up IP6 options in pcb for insertion in output packets or
   2067   1.97    rpaulo  * specifying behavior of outgoing packets.
   2068    1.2    itojun  */
   2069    1.2    itojun static int
   2070  1.130    plunky ip6_pcbopts(struct ip6_pktopts **pktopt, struct socket *so,
   2071  1.130    plunky     struct sockopt *sopt)
   2072    1.2    itojun {
   2073   1.31    itojun 	struct ip6_pktopts *opt = *pktopt;
   2074  1.130    plunky 	struct mbuf *m;
   2075    1.2    itojun 	int error = 0;
   2076    1.2    itojun 
   2077  1.185     ozaki 	KASSERT(solocked(so));
   2078  1.185     ozaki 
   2079    1.2    itojun 	/* turn off any old options. */
   2080    1.2    itojun 	if (opt) {
   2081   1.97    rpaulo #ifdef DIAGNOSTIC
   2082   1.97    rpaulo 	    if (opt->ip6po_pktinfo || opt->ip6po_nexthop ||
   2083   1.97    rpaulo 		opt->ip6po_hbh || opt->ip6po_dest1 || opt->ip6po_dest2 ||
   2084   1.97    rpaulo 		opt->ip6po_rhinfo.ip6po_rhi_rthdr)
   2085   1.97    rpaulo 		    printf("ip6_pcbopts: all specified options are cleared.\n");
   2086   1.97    rpaulo #endif
   2087   1.97    rpaulo 		ip6_clearpktopts(opt, -1);
   2088  1.134    plunky 	} else {
   2089  1.134    plunky 		opt = malloc(sizeof(*opt), M_IP6OPT, M_NOWAIT);
   2090  1.134    plunky 		if (opt == NULL)
   2091  1.134    plunky 			return (ENOBUFS);
   2092  1.134    plunky 	}
   2093   1.97    rpaulo 	*pktopt = NULL;
   2094    1.2    itojun 
   2095  1.130    plunky 	if (sopt == NULL || sopt->sopt_size == 0) {
   2096    1.2    itojun 		/*
   2097   1.97    rpaulo 		 * Only turning off any previous options, regardless of
   2098   1.97    rpaulo 		 * whether the opt is just created or given.
   2099    1.2    itojun 		 */
   2100   1.59    itojun 		free(opt, M_IP6OPT);
   2101   1.57    itojun 		return (0);
   2102    1.2    itojun 	}
   2103    1.2    itojun 
   2104    1.2    itojun 	/*  set options specified by user. */
   2105  1.130    plunky 	m = sockopt_getmbuf(sopt);
   2106  1.135    plunky 	if (m == NULL) {
   2107  1.135    plunky 		free(opt, M_IP6OPT);
   2108  1.135    plunky 		return (ENOBUFS);
   2109  1.135    plunky 	}
   2110  1.135    plunky 
   2111  1.138      elad 	error = ip6_setpktopts(m, opt, NULL, kauth_cred_get(),
   2112  1.138      elad 	    so->so_proto->pr_protocol);
   2113  1.130    plunky 	m_freem(m);
   2114  1.130    plunky 	if (error != 0) {
   2115   1.97    rpaulo 		ip6_clearpktopts(opt, -1); /* XXX: discard all options */
   2116   1.59    itojun 		free(opt, M_IP6OPT);
   2117   1.57    itojun 		return (error);
   2118    1.2    itojun 	}
   2119    1.2    itojun 	*pktopt = opt;
   2120   1.57    itojun 	return (0);
   2121    1.2    itojun }
   2122   1.97    rpaulo #endif
   2123   1.97    rpaulo 
   2124   1.97    rpaulo /*
   2125   1.97    rpaulo  * initialize ip6_pktopts.  beware that there are non-zero default values in
   2126   1.97    rpaulo  * the struct.
   2127   1.97    rpaulo  */
   2128   1.97    rpaulo void
   2129   1.97    rpaulo ip6_initpktopts(struct ip6_pktopts *opt)
   2130   1.97    rpaulo {
   2131   1.97    rpaulo 
   2132   1.97    rpaulo 	memset(opt, 0, sizeof(*opt));
   2133   1.97    rpaulo 	opt->ip6po_hlim = -1;	/* -1 means default hop limit */
   2134   1.97    rpaulo 	opt->ip6po_tclass = -1;	/* -1 means default traffic class */
   2135   1.97    rpaulo 	opt->ip6po_minmtu = IP6PO_MINMTU_MCASTONLY;
   2136  1.161       roy 	opt->ip6po_prefer_tempaddr = IP6PO_TEMPADDR_SYSTEM;
   2137   1.97    rpaulo }
   2138   1.97    rpaulo 
   2139   1.97    rpaulo #define sin6tosa(sin6)	((struct sockaddr *)(sin6)) /* XXX */
   2140   1.97    rpaulo static int
   2141   1.97    rpaulo ip6_pcbopt(int optname, u_char *buf, int len, struct ip6_pktopts **pktopt,
   2142  1.138      elad     kauth_cred_t cred, int uproto)
   2143   1.97    rpaulo {
   2144   1.97    rpaulo 	struct ip6_pktopts *opt;
   2145   1.97    rpaulo 
   2146   1.97    rpaulo 	if (*pktopt == NULL) {
   2147   1.97    rpaulo 		*pktopt = malloc(sizeof(struct ip6_pktopts), M_IP6OPT,
   2148  1.133    plunky 		    M_NOWAIT);
   2149  1.133    plunky 		if (*pktopt == NULL)
   2150  1.133    plunky 			return (ENOBUFS);
   2151  1.133    plunky 
   2152   1.97    rpaulo 		ip6_initpktopts(*pktopt);
   2153   1.97    rpaulo 	}
   2154   1.97    rpaulo 	opt = *pktopt;
   2155   1.97    rpaulo 
   2156  1.138      elad 	return (ip6_setpktopt(optname, buf, len, opt, cred, 1, 0, uproto));
   2157   1.97    rpaulo }
   2158   1.97    rpaulo 
   2159   1.97    rpaulo static int
   2160  1.130    plunky ip6_getpcbopt(struct ip6_pktopts *pktopt, int optname, struct sockopt *sopt)
   2161   1.97    rpaulo {
   2162   1.97    rpaulo 	void *optdata = NULL;
   2163   1.97    rpaulo 	int optdatalen = 0;
   2164   1.97    rpaulo 	struct ip6_ext *ip6e;
   2165   1.97    rpaulo 	int error = 0;
   2166   1.97    rpaulo 	struct in6_pktinfo null_pktinfo;
   2167   1.97    rpaulo 	int deftclass = 0, on;
   2168   1.97    rpaulo 	int defminmtu = IP6PO_MINMTU_MCASTONLY;
   2169  1.161       roy 	int defpreftemp = IP6PO_TEMPADDR_SYSTEM;
   2170   1.97    rpaulo 
   2171   1.97    rpaulo 	switch (optname) {
   2172   1.97    rpaulo 	case IPV6_PKTINFO:
   2173   1.97    rpaulo 		if (pktopt && pktopt->ip6po_pktinfo)
   2174   1.97    rpaulo 			optdata = (void *)pktopt->ip6po_pktinfo;
   2175   1.97    rpaulo 		else {
   2176   1.97    rpaulo 			/* XXX: we don't have to do this every time... */
   2177   1.97    rpaulo 			memset(&null_pktinfo, 0, sizeof(null_pktinfo));
   2178   1.97    rpaulo 			optdata = (void *)&null_pktinfo;
   2179   1.97    rpaulo 		}
   2180   1.97    rpaulo 		optdatalen = sizeof(struct in6_pktinfo);
   2181   1.97    rpaulo 		break;
   2182   1.97    rpaulo 	case IPV6_OTCLASS:
   2183   1.97    rpaulo 		/* XXX */
   2184   1.97    rpaulo 		return (EINVAL);
   2185   1.97    rpaulo 	case IPV6_TCLASS:
   2186   1.97    rpaulo 		if (pktopt && pktopt->ip6po_tclass >= 0)
   2187   1.97    rpaulo 			optdata = (void *)&pktopt->ip6po_tclass;
   2188   1.97    rpaulo 		else
   2189   1.97    rpaulo 			optdata = (void *)&deftclass;
   2190   1.97    rpaulo 		optdatalen = sizeof(int);
   2191   1.97    rpaulo 		break;
   2192   1.97    rpaulo 	case IPV6_HOPOPTS:
   2193   1.97    rpaulo 		if (pktopt && pktopt->ip6po_hbh) {
   2194   1.97    rpaulo 			optdata = (void *)pktopt->ip6po_hbh;
   2195   1.97    rpaulo 			ip6e = (struct ip6_ext *)pktopt->ip6po_hbh;
   2196   1.97    rpaulo 			optdatalen = (ip6e->ip6e_len + 1) << 3;
   2197   1.97    rpaulo 		}
   2198   1.97    rpaulo 		break;
   2199   1.97    rpaulo 	case IPV6_RTHDR:
   2200   1.97    rpaulo 		if (pktopt && pktopt->ip6po_rthdr) {
   2201   1.97    rpaulo 			optdata = (void *)pktopt->ip6po_rthdr;
   2202   1.97    rpaulo 			ip6e = (struct ip6_ext *)pktopt->ip6po_rthdr;
   2203   1.97    rpaulo 			optdatalen = (ip6e->ip6e_len + 1) << 3;
   2204   1.97    rpaulo 		}
   2205   1.97    rpaulo 		break;
   2206   1.97    rpaulo 	case IPV6_RTHDRDSTOPTS:
   2207   1.97    rpaulo 		if (pktopt && pktopt->ip6po_dest1) {
   2208   1.97    rpaulo 			optdata = (void *)pktopt->ip6po_dest1;
   2209   1.97    rpaulo 			ip6e = (struct ip6_ext *)pktopt->ip6po_dest1;
   2210   1.97    rpaulo 			optdatalen = (ip6e->ip6e_len + 1) << 3;
   2211   1.97    rpaulo 		}
   2212   1.97    rpaulo 		break;
   2213   1.97    rpaulo 	case IPV6_DSTOPTS:
   2214   1.97    rpaulo 		if (pktopt && pktopt->ip6po_dest2) {
   2215   1.97    rpaulo 			optdata = (void *)pktopt->ip6po_dest2;
   2216   1.97    rpaulo 			ip6e = (struct ip6_ext *)pktopt->ip6po_dest2;
   2217   1.97    rpaulo 			optdatalen = (ip6e->ip6e_len + 1) << 3;
   2218   1.97    rpaulo 		}
   2219   1.97    rpaulo 		break;
   2220   1.97    rpaulo 	case IPV6_NEXTHOP:
   2221   1.97    rpaulo 		if (pktopt && pktopt->ip6po_nexthop) {
   2222   1.97    rpaulo 			optdata = (void *)pktopt->ip6po_nexthop;
   2223   1.97    rpaulo 			optdatalen = pktopt->ip6po_nexthop->sa_len;
   2224   1.97    rpaulo 		}
   2225   1.97    rpaulo 		break;
   2226   1.97    rpaulo 	case IPV6_USE_MIN_MTU:
   2227   1.97    rpaulo 		if (pktopt)
   2228   1.97    rpaulo 			optdata = (void *)&pktopt->ip6po_minmtu;
   2229   1.97    rpaulo 		else
   2230   1.97    rpaulo 			optdata = (void *)&defminmtu;
   2231   1.97    rpaulo 		optdatalen = sizeof(int);
   2232   1.97    rpaulo 		break;
   2233   1.97    rpaulo 	case IPV6_DONTFRAG:
   2234   1.97    rpaulo 		if (pktopt && ((pktopt->ip6po_flags) & IP6PO_DONTFRAG))
   2235   1.97    rpaulo 			on = 1;
   2236   1.97    rpaulo 		else
   2237   1.97    rpaulo 			on = 0;
   2238   1.97    rpaulo 		optdata = (void *)&on;
   2239   1.97    rpaulo 		optdatalen = sizeof(on);
   2240   1.97    rpaulo 		break;
   2241  1.161       roy 	case IPV6_PREFER_TEMPADDR:
   2242  1.161       roy 		if (pktopt)
   2243  1.161       roy 			optdata = (void *)&pktopt->ip6po_prefer_tempaddr;
   2244  1.161       roy 		else
   2245  1.161       roy 			optdata = (void *)&defpreftemp;
   2246  1.161       roy 		optdatalen = sizeof(int);
   2247  1.163  christos 		break;
   2248   1.97    rpaulo 	default:		/* should not happen */
   2249   1.97    rpaulo #ifdef DIAGNOSTIC
   2250   1.97    rpaulo 		panic("ip6_getpcbopt: unexpected option\n");
   2251   1.97    rpaulo #endif
   2252   1.97    rpaulo 		return (ENOPROTOOPT);
   2253   1.97    rpaulo 	}
   2254   1.97    rpaulo 
   2255  1.130    plunky 	error = sockopt_set(sopt, optdata, optdatalen);
   2256   1.97    rpaulo 
   2257   1.97    rpaulo 	return (error);
   2258   1.97    rpaulo }
   2259   1.97    rpaulo 
   2260   1.97    rpaulo void
   2261   1.97    rpaulo ip6_clearpktopts(struct ip6_pktopts *pktopt, int optname)
   2262   1.97    rpaulo {
   2263   1.97    rpaulo 	if (optname == -1 || optname == IPV6_PKTINFO) {
   2264   1.97    rpaulo 		if (pktopt->ip6po_pktinfo)
   2265   1.97    rpaulo 			free(pktopt->ip6po_pktinfo, M_IP6OPT);
   2266   1.97    rpaulo 		pktopt->ip6po_pktinfo = NULL;
   2267   1.97    rpaulo 	}
   2268   1.97    rpaulo 	if (optname == -1 || optname == IPV6_HOPLIMIT)
   2269   1.97    rpaulo 		pktopt->ip6po_hlim = -1;
   2270   1.97    rpaulo 	if (optname == -1 || optname == IPV6_TCLASS)
   2271   1.97    rpaulo 		pktopt->ip6po_tclass = -1;
   2272   1.97    rpaulo 	if (optname == -1 || optname == IPV6_NEXTHOP) {
   2273  1.118    dyoung 		rtcache_free(&pktopt->ip6po_nextroute);
   2274   1.97    rpaulo 		if (pktopt->ip6po_nexthop)
   2275   1.97    rpaulo 			free(pktopt->ip6po_nexthop, M_IP6OPT);
   2276   1.97    rpaulo 		pktopt->ip6po_nexthop = NULL;
   2277   1.97    rpaulo 	}
   2278   1.97    rpaulo 	if (optname == -1 || optname == IPV6_HOPOPTS) {
   2279   1.97    rpaulo 		if (pktopt->ip6po_hbh)
   2280   1.97    rpaulo 			free(pktopt->ip6po_hbh, M_IP6OPT);
   2281   1.97    rpaulo 		pktopt->ip6po_hbh = NULL;
   2282   1.97    rpaulo 	}
   2283   1.97    rpaulo 	if (optname == -1 || optname == IPV6_RTHDRDSTOPTS) {
   2284   1.97    rpaulo 		if (pktopt->ip6po_dest1)
   2285   1.97    rpaulo 			free(pktopt->ip6po_dest1, M_IP6OPT);
   2286   1.97    rpaulo 		pktopt->ip6po_dest1 = NULL;
   2287   1.97    rpaulo 	}
   2288   1.97    rpaulo 	if (optname == -1 || optname == IPV6_RTHDR) {
   2289   1.97    rpaulo 		if (pktopt->ip6po_rhinfo.ip6po_rhi_rthdr)
   2290   1.97    rpaulo 			free(pktopt->ip6po_rhinfo.ip6po_rhi_rthdr, M_IP6OPT);
   2291   1.97    rpaulo 		pktopt->ip6po_rhinfo.ip6po_rhi_rthdr = NULL;
   2292  1.118    dyoung 		rtcache_free(&pktopt->ip6po_route);
   2293   1.97    rpaulo 	}
   2294   1.97    rpaulo 	if (optname == -1 || optname == IPV6_DSTOPTS) {
   2295   1.97    rpaulo 		if (pktopt->ip6po_dest2)
   2296   1.97    rpaulo 			free(pktopt->ip6po_dest2, M_IP6OPT);
   2297   1.97    rpaulo 		pktopt->ip6po_dest2 = NULL;
   2298   1.97    rpaulo 	}
   2299   1.97    rpaulo }
   2300   1.97    rpaulo 
   2301   1.97    rpaulo #define PKTOPT_EXTHDRCPY(type) 					\
   2302   1.97    rpaulo do {								\
   2303   1.97    rpaulo 	if (src->type) {					\
   2304   1.97    rpaulo 		int hlen = (((struct ip6_ext *)src->type)->ip6e_len + 1) << 3;\
   2305   1.97    rpaulo 		dst->type = malloc(hlen, M_IP6OPT, canwait);	\
   2306  1.144  drochner 		if (dst->type == NULL)				\
   2307   1.97    rpaulo 			goto bad;				\
   2308   1.97    rpaulo 		memcpy(dst->type, src->type, hlen);		\
   2309   1.97    rpaulo 	}							\
   2310   1.97    rpaulo } while (/*CONSTCOND*/ 0)
   2311   1.97    rpaulo 
   2312   1.97    rpaulo static int
   2313   1.97    rpaulo copypktopts(struct ip6_pktopts *dst, struct ip6_pktopts *src, int canwait)
   2314   1.97    rpaulo {
   2315   1.97    rpaulo 	dst->ip6po_hlim = src->ip6po_hlim;
   2316   1.97    rpaulo 	dst->ip6po_tclass = src->ip6po_tclass;
   2317   1.97    rpaulo 	dst->ip6po_flags = src->ip6po_flags;
   2318  1.162       roy 	dst->ip6po_minmtu = src->ip6po_minmtu;
   2319  1.161       roy 	dst->ip6po_prefer_tempaddr = src->ip6po_prefer_tempaddr;
   2320   1.97    rpaulo 	if (src->ip6po_pktinfo) {
   2321   1.97    rpaulo 		dst->ip6po_pktinfo = malloc(sizeof(*dst->ip6po_pktinfo),
   2322   1.97    rpaulo 		    M_IP6OPT, canwait);
   2323  1.144  drochner 		if (dst->ip6po_pktinfo == NULL)
   2324   1.97    rpaulo 			goto bad;
   2325   1.97    rpaulo 		*dst->ip6po_pktinfo = *src->ip6po_pktinfo;
   2326   1.97    rpaulo 	}
   2327   1.97    rpaulo 	if (src->ip6po_nexthop) {
   2328   1.97    rpaulo 		dst->ip6po_nexthop = malloc(src->ip6po_nexthop->sa_len,
   2329   1.97    rpaulo 		    M_IP6OPT, canwait);
   2330  1.144  drochner 		if (dst->ip6po_nexthop == NULL)
   2331   1.97    rpaulo 			goto bad;
   2332   1.97    rpaulo 		memcpy(dst->ip6po_nexthop, src->ip6po_nexthop,
   2333   1.97    rpaulo 		    src->ip6po_nexthop->sa_len);
   2334   1.97    rpaulo 	}
   2335   1.97    rpaulo 	PKTOPT_EXTHDRCPY(ip6po_hbh);
   2336   1.97    rpaulo 	PKTOPT_EXTHDRCPY(ip6po_dest1);
   2337   1.97    rpaulo 	PKTOPT_EXTHDRCPY(ip6po_dest2);
   2338   1.97    rpaulo 	PKTOPT_EXTHDRCPY(ip6po_rthdr); /* not copy the cached route */
   2339   1.97    rpaulo 	return (0);
   2340   1.97    rpaulo 
   2341   1.97    rpaulo   bad:
   2342   1.97    rpaulo 	if (dst->ip6po_pktinfo) free(dst->ip6po_pktinfo, M_IP6OPT);
   2343   1.97    rpaulo 	if (dst->ip6po_nexthop) free(dst->ip6po_nexthop, M_IP6OPT);
   2344   1.97    rpaulo 	if (dst->ip6po_hbh) free(dst->ip6po_hbh, M_IP6OPT);
   2345   1.97    rpaulo 	if (dst->ip6po_dest1) free(dst->ip6po_dest1, M_IP6OPT);
   2346   1.97    rpaulo 	if (dst->ip6po_dest2) free(dst->ip6po_dest2, M_IP6OPT);
   2347   1.97    rpaulo 	if (dst->ip6po_rthdr) free(dst->ip6po_rthdr, M_IP6OPT);
   2348   1.97    rpaulo 
   2349   1.97    rpaulo 	return (ENOBUFS);
   2350   1.97    rpaulo }
   2351   1.97    rpaulo #undef PKTOPT_EXTHDRCPY
   2352   1.97    rpaulo 
   2353   1.97    rpaulo struct ip6_pktopts *
   2354   1.97    rpaulo ip6_copypktopts(struct ip6_pktopts *src, int canwait)
   2355   1.97    rpaulo {
   2356   1.97    rpaulo 	int error;
   2357   1.97    rpaulo 	struct ip6_pktopts *dst;
   2358   1.97    rpaulo 
   2359   1.97    rpaulo 	dst = malloc(sizeof(*dst), M_IP6OPT, canwait);
   2360  1.144  drochner 	if (dst == NULL)
   2361   1.97    rpaulo 		return (NULL);
   2362   1.97    rpaulo 	ip6_initpktopts(dst);
   2363   1.97    rpaulo 
   2364   1.97    rpaulo 	if ((error = copypktopts(dst, src, canwait)) != 0) {
   2365   1.97    rpaulo 		free(dst, M_IP6OPT);
   2366   1.97    rpaulo 		return (NULL);
   2367   1.97    rpaulo 	}
   2368   1.97    rpaulo 
   2369   1.97    rpaulo 	return (dst);
   2370   1.97    rpaulo }
   2371   1.97    rpaulo 
   2372   1.97    rpaulo void
   2373   1.97    rpaulo ip6_freepcbopts(struct ip6_pktopts *pktopt)
   2374   1.97    rpaulo {
   2375   1.97    rpaulo 	if (pktopt == NULL)
   2376   1.97    rpaulo 		return;
   2377   1.97    rpaulo 
   2378   1.97    rpaulo 	ip6_clearpktopts(pktopt, -1);
   2379   1.97    rpaulo 
   2380   1.97    rpaulo 	free(pktopt, M_IP6OPT);
   2381   1.97    rpaulo }
   2382    1.2    itojun 
   2383  1.160  christos int
   2384  1.189     ozaki ip6_get_membership(const struct sockopt *sopt, struct ifnet **ifp,
   2385  1.189     ozaki     struct psref *psref, void *v, size_t l)
   2386  1.160  christos {
   2387  1.160  christos 	struct ipv6_mreq mreq;
   2388  1.160  christos 	int error;
   2389  1.160  christos 	struct in6_addr *ia = &mreq.ipv6mr_multiaddr;
   2390  1.160  christos 	struct in_addr *ia4 = (void *)&ia->s6_addr32[3];
   2391  1.189     ozaki 
   2392  1.160  christos 	error = sockopt_get(sopt, &mreq, sizeof(mreq));
   2393  1.160  christos 	if (error != 0)
   2394  1.160  christos 		return error;
   2395  1.160  christos 
   2396  1.160  christos 	if (IN6_IS_ADDR_UNSPECIFIED(ia)) {
   2397  1.160  christos 		/*
   2398  1.160  christos 		 * We use the unspecified address to specify to accept
   2399  1.160  christos 		 * all multicast addresses. Only super user is allowed
   2400  1.160  christos 		 * to do this.
   2401  1.160  christos 		 */
   2402  1.160  christos 		if (kauth_authorize_network(curlwp->l_cred, KAUTH_NETWORK_IPV6,
   2403  1.160  christos 		    KAUTH_REQ_NETWORK_IPV6_JOIN_MULTICAST, NULL, NULL, NULL))
   2404  1.160  christos 			return EACCES;
   2405  1.160  christos 	} else if (IN6_IS_ADDR_V4MAPPED(ia)) {
   2406  1.160  christos 		// Don't bother if we are not going to use ifp.
   2407  1.160  christos 		if (l == sizeof(*ia)) {
   2408  1.160  christos 			memcpy(v, ia, l);
   2409  1.160  christos 			return 0;
   2410  1.160  christos 		}
   2411  1.160  christos 	} else if (!IN6_IS_ADDR_MULTICAST(ia)) {
   2412  1.160  christos 		return EINVAL;
   2413  1.160  christos 	}
   2414  1.160  christos 
   2415  1.160  christos 	/*
   2416  1.160  christos 	 * If no interface was explicitly specified, choose an
   2417  1.160  christos 	 * appropriate one according to the given multicast address.
   2418  1.160  christos 	 */
   2419  1.160  christos 	if (mreq.ipv6mr_interface == 0) {
   2420  1.160  christos 		struct rtentry *rt;
   2421  1.160  christos 		union {
   2422  1.160  christos 			struct sockaddr		dst;
   2423  1.160  christos 			struct sockaddr_in	dst4;
   2424  1.160  christos 			struct sockaddr_in6	dst6;
   2425  1.160  christos 		} u;
   2426  1.160  christos 		struct route ro;
   2427  1.160  christos 
   2428  1.160  christos 		/*
   2429  1.160  christos 		 * Look up the routing table for the
   2430  1.160  christos 		 * address, and choose the outgoing interface.
   2431  1.160  christos 		 *   XXX: is it a good approach?
   2432  1.160  christos 		 */
   2433  1.160  christos 		memset(&ro, 0, sizeof(ro));
   2434  1.160  christos 		if (IN6_IS_ADDR_V4MAPPED(ia))
   2435  1.160  christos 			sockaddr_in_init(&u.dst4, ia4, 0);
   2436  1.160  christos 		else
   2437  1.160  christos 			sockaddr_in6_init(&u.dst6, ia, 0, 0, 0);
   2438  1.165     ozaki 		error = rtcache_setdst(&ro, &u.dst);
   2439  1.165     ozaki 		if (error != 0)
   2440  1.165     ozaki 			return error;
   2441  1.179     ozaki 		rt = rtcache_init(&ro);
   2442  1.189     ozaki 		*ifp = rt != NULL ?
   2443  1.189     ozaki 		    if_get_byindex(rt->rt_ifp->if_index, psref) : NULL;
   2444  1.179     ozaki 		rtcache_unref(rt, &ro);
   2445  1.160  christos 		rtcache_free(&ro);
   2446  1.160  christos 	} else {
   2447  1.160  christos 		/*
   2448  1.160  christos 		 * If the interface is specified, validate it.
   2449  1.160  christos 		 */
   2450  1.189     ozaki 		*ifp = if_get_byindex(mreq.ipv6mr_interface, psref);
   2451  1.189     ozaki 		if (*ifp == NULL)
   2452  1.160  christos 			return ENXIO;	/* XXX EINVAL? */
   2453  1.160  christos 	}
   2454  1.160  christos 	if (sizeof(*ia) == l)
   2455  1.160  christos 		memcpy(v, ia, l);
   2456  1.160  christos 	else
   2457  1.160  christos 		memcpy(v, ia4, l);
   2458  1.160  christos 	return 0;
   2459  1.160  christos }
   2460  1.160  christos 
   2461    1.2    itojun /*
   2462    1.2    itojun  * Set the IP6 multicast options in response to user setsockopt().
   2463    1.2    itojun  */
   2464    1.2    itojun static int
   2465  1.160  christos ip6_setmoptions(const struct sockopt *sopt, struct in6pcb *in6p)
   2466    1.2    itojun {
   2467    1.2    itojun 	int error = 0;
   2468    1.2    itojun 	u_int loop, ifindex;
   2469  1.132    plunky 	struct ipv6_mreq mreq;
   2470  1.160  christos 	struct in6_addr ia;
   2471    1.2    itojun 	struct ifnet *ifp;
   2472  1.160  christos 	struct ip6_moptions *im6o = in6p->in6p_moptions;
   2473    1.2    itojun 	struct in6_multi_mship *imm;
   2474    1.2    itojun 
   2475  1.190     ozaki 	KASSERT(in6p_locked(in6p));
   2476  1.185     ozaki 
   2477    1.2    itojun 	if (im6o == NULL) {
   2478    1.2    itojun 		/*
   2479    1.2    itojun 		 * No multicast option buffer attached to the pcb;
   2480    1.2    itojun 		 * allocate one and initialize to default values.
   2481    1.2    itojun 		 */
   2482  1.132    plunky 		im6o = malloc(sizeof(*im6o), M_IPMOPTS, M_NOWAIT);
   2483    1.2    itojun 		if (im6o == NULL)
   2484   1.57    itojun 			return (ENOBUFS);
   2485  1.160  christos 		in6p->in6p_moptions = im6o;
   2486  1.168     ozaki 		im6o->im6o_multicast_if_index = 0;
   2487    1.2    itojun 		im6o->im6o_multicast_hlim = ip6_defmcasthlim;
   2488    1.2    itojun 		im6o->im6o_multicast_loop = IPV6_DEFAULT_MULTICAST_LOOP;
   2489    1.2    itojun 		LIST_INIT(&im6o->im6o_memberships);
   2490    1.2    itojun 	}
   2491    1.2    itojun 
   2492  1.132    plunky 	switch (sopt->sopt_name) {
   2493    1.2    itojun 
   2494  1.189     ozaki 	case IPV6_MULTICAST_IF: {
   2495  1.189     ozaki 		int s;
   2496    1.2    itojun 		/*
   2497    1.2    itojun 		 * Select the interface for outgoing multicast packets.
   2498    1.2    itojun 		 */
   2499  1.132    plunky 		error = sockopt_get(sopt, &ifindex, sizeof(ifindex));
   2500  1.132    plunky 		if (error != 0)
   2501    1.2    itojun 			break;
   2502  1.132    plunky 
   2503  1.189     ozaki 		s = pserialize_read_enter();
   2504   1.87  drochner 		if (ifindex != 0) {
   2505  1.156     rmind 			if ((ifp = if_byindex(ifindex)) == NULL) {
   2506  1.189     ozaki 				pserialize_read_exit(s);
   2507   1.87  drochner 				error = ENXIO;	/* XXX EINVAL? */
   2508   1.87  drochner 				break;
   2509   1.87  drochner 			}
   2510   1.87  drochner 			if ((ifp->if_flags & IFF_MULTICAST) == 0) {
   2511  1.189     ozaki 				pserialize_read_exit(s);
   2512   1.87  drochner 				error = EADDRNOTAVAIL;
   2513   1.87  drochner 				break;
   2514   1.87  drochner 			}
   2515   1.87  drochner 		} else
   2516   1.87  drochner 			ifp = NULL;
   2517  1.168     ozaki 		im6o->im6o_multicast_if_index = if_get_index(ifp);
   2518  1.189     ozaki 		pserialize_read_exit(s);
   2519    1.2    itojun 		break;
   2520  1.189     ozaki 	    }
   2521    1.2    itojun 
   2522    1.2    itojun 	case IPV6_MULTICAST_HOPS:
   2523    1.2    itojun 	    {
   2524    1.2    itojun 		/*
   2525    1.2    itojun 		 * Set the IP6 hoplimit for outgoing multicast packets.
   2526    1.2    itojun 		 */
   2527    1.2    itojun 		int optval;
   2528  1.132    plunky 
   2529  1.132    plunky 		error = sockopt_getint(sopt, &optval);
   2530  1.132    plunky 		if (error != 0)
   2531    1.2    itojun 			break;
   2532  1.132    plunky 
   2533    1.2    itojun 		if (optval < -1 || optval >= 256)
   2534    1.2    itojun 			error = EINVAL;
   2535    1.2    itojun 		else if (optval == -1)
   2536    1.2    itojun 			im6o->im6o_multicast_hlim = ip6_defmcasthlim;
   2537    1.2    itojun 		else
   2538    1.2    itojun 			im6o->im6o_multicast_hlim = optval;
   2539    1.2    itojun 		break;
   2540    1.2    itojun 	    }
   2541    1.2    itojun 
   2542    1.2    itojun 	case IPV6_MULTICAST_LOOP:
   2543    1.2    itojun 		/*
   2544    1.2    itojun 		 * Set the loopback flag for outgoing multicast packets.
   2545    1.2    itojun 		 * Must be zero or one.
   2546    1.2    itojun 		 */
   2547  1.132    plunky 		error = sockopt_get(sopt, &loop, sizeof(loop));
   2548  1.132    plunky 		if (error != 0)
   2549   1.25    itojun 			break;
   2550   1.25    itojun 		if (loop > 1) {
   2551    1.2    itojun 			error = EINVAL;
   2552    1.2    itojun 			break;
   2553    1.2    itojun 		}
   2554    1.2    itojun 		im6o->im6o_multicast_loop = loop;
   2555    1.2    itojun 		break;
   2556    1.2    itojun 
   2557  1.189     ozaki 	case IPV6_JOIN_GROUP: {
   2558  1.189     ozaki 		int bound;
   2559  1.189     ozaki 		struct psref psref;
   2560    1.2    itojun 		/*
   2561    1.2    itojun 		 * Add a multicast group membership.
   2562    1.2    itojun 		 * Group must be a valid IP6 multicast address.
   2563    1.2    itojun 		 */
   2564  1.189     ozaki 		bound = curlwp_bind();
   2565  1.192     ozaki 		ifp = NULL;
   2566  1.189     ozaki 		error = ip6_get_membership(sopt, &ifp, &psref, &ia, sizeof(ia));
   2567  1.189     ozaki 		if (error != 0) {
   2568  1.192     ozaki 			KASSERT(ifp == NULL);
   2569  1.189     ozaki 			curlwp_bindx(bound);
   2570  1.160  christos 			return error;
   2571  1.189     ozaki 		}
   2572  1.132    plunky 
   2573  1.160  christos 		if (IN6_IS_ADDR_V4MAPPED(&ia)) {
   2574  1.160  christos 			error = ip_setmoptions(&in6p->in6p_v4moptions, sopt);
   2575  1.189     ozaki 			goto put_break;
   2576    1.2    itojun 		}
   2577    1.2    itojun 		/*
   2578    1.2    itojun 		 * See if we found an interface, and confirm that it
   2579    1.2    itojun 		 * supports multicast
   2580    1.2    itojun 		 */
   2581    1.2    itojun 		if (ifp == NULL || (ifp->if_flags & IFF_MULTICAST) == 0) {
   2582    1.2    itojun 			error = EADDRNOTAVAIL;
   2583  1.189     ozaki 			goto put_break;
   2584    1.2    itojun 		}
   2585   1.94    rpaulo 
   2586  1.160  christos 		if (in6_setscope(&ia, ifp, NULL)) {
   2587   1.94    rpaulo 			error = EADDRNOTAVAIL; /* XXX: should not happen */
   2588  1.189     ozaki 			goto put_break;
   2589    1.2    itojun 		}
   2590   1.94    rpaulo 
   2591    1.2    itojun 		/*
   2592    1.2    itojun 		 * See if the membership already exists.
   2593    1.2    itojun 		 */
   2594  1.188     ozaki 		LIST_FOREACH(imm, &im6o->im6o_memberships, i6mm_chain) {
   2595    1.2    itojun 			if (imm->i6mm_maddr->in6m_ifp == ifp &&
   2596    1.2    itojun 			    IN6_ARE_ADDR_EQUAL(&imm->i6mm_maddr->in6m_addr,
   2597  1.160  christos 			    &ia))
   2598  1.189     ozaki 				goto put_break;
   2599  1.188     ozaki 		}
   2600    1.2    itojun 		if (imm != NULL) {
   2601    1.2    itojun 			error = EADDRINUSE;
   2602  1.189     ozaki 			goto put_break;
   2603    1.2    itojun 		}
   2604    1.2    itojun 		/*
   2605    1.2    itojun 		 * Everything looks good; add a new record to the multicast
   2606    1.2    itojun 		 * address list for the given interface.
   2607    1.2    itojun 		 */
   2608  1.196     ozaki 		IFNET_LOCK(ifp);
   2609  1.160  christos 		imm = in6_joingroup(ifp, &ia, &error, 0);
   2610  1.196     ozaki 		IFNET_UNLOCK(ifp);
   2611   1.95    rpaulo 		if (imm == NULL)
   2612  1.189     ozaki 			goto put_break;
   2613    1.2    itojun 		LIST_INSERT_HEAD(&im6o->im6o_memberships, imm, i6mm_chain);
   2614  1.189     ozaki 	    put_break:
   2615  1.189     ozaki 		if_put(ifp, &psref);
   2616  1.189     ozaki 		curlwp_bindx(bound);
   2617    1.2    itojun 		break;
   2618  1.189     ozaki 	    }
   2619    1.2    itojun 
   2620  1.196     ozaki 	case IPV6_LEAVE_GROUP: {
   2621  1.196     ozaki 		struct ifnet *in6m_ifp;
   2622    1.2    itojun 		/*
   2623    1.2    itojun 		 * Drop a multicast group membership.
   2624    1.2    itojun 		 * Group must be a valid IP6 multicast address.
   2625    1.2    itojun 		 */
   2626  1.132    plunky 		error = sockopt_get(sopt, &mreq, sizeof(mreq));
   2627  1.132    plunky 		if (error != 0)
   2628    1.2    itojun 			break;
   2629   1.94    rpaulo 
   2630  1.160  christos 		if (IN6_IS_ADDR_V4MAPPED(&mreq.ipv6mr_multiaddr)) {
   2631  1.160  christos 			error = ip_setmoptions(&in6p->in6p_v4moptions, sopt);
   2632  1.160  christos 			break;
   2633  1.160  christos 		}
   2634    1.2    itojun 		/*
   2635    1.2    itojun 		 * If an interface address was specified, get a pointer
   2636    1.2    itojun 		 * to its ifnet structure.
   2637    1.2    itojun 		 */
   2638  1.132    plunky 		if (mreq.ipv6mr_interface != 0) {
   2639  1.156     rmind 			if ((ifp = if_byindex(mreq.ipv6mr_interface)) == NULL) {
   2640   1.87  drochner 				error = ENXIO;	/* XXX EINVAL? */
   2641   1.87  drochner 				break;
   2642   1.87  drochner 			}
   2643   1.87  drochner 		} else
   2644   1.87  drochner 			ifp = NULL;
   2645   1.94    rpaulo 
   2646   1.94    rpaulo 		/* Fill in the scope zone ID */
   2647   1.94    rpaulo 		if (ifp) {
   2648  1.132    plunky 			if (in6_setscope(&mreq.ipv6mr_multiaddr, ifp, NULL)) {
   2649   1.94    rpaulo 				/* XXX: should not happen */
   2650   1.94    rpaulo 				error = EADDRNOTAVAIL;
   2651   1.94    rpaulo 				break;
   2652   1.94    rpaulo 			}
   2653  1.132    plunky 		} else if (mreq.ipv6mr_interface != 0) {
   2654   1.94    rpaulo 			/*
   2655   1.94    rpaulo 			 * XXX: This case would happens when the (positive)
   2656   1.94    rpaulo 			 * index is in the valid range, but the corresponding
   2657   1.94    rpaulo 			 * interface has been detached dynamically.  The above
   2658   1.94    rpaulo 			 * check probably avoids such case to happen here, but
   2659   1.94    rpaulo 			 * we check it explicitly for safety.
   2660   1.94    rpaulo 			 */
   2661   1.94    rpaulo 			error = EADDRNOTAVAIL;
   2662  1.197      maxv 			break;
   2663   1.94    rpaulo 		} else {	/* ipv6mr_interface == 0 */
   2664   1.94    rpaulo 			struct sockaddr_in6 sa6_mc;
   2665   1.94    rpaulo 
   2666   1.94    rpaulo 			/*
   2667   1.94    rpaulo 			 * The API spec says as follows:
   2668   1.94    rpaulo 			 *  If the interface index is specified as 0, the
   2669   1.94    rpaulo 			 *  system may choose a multicast group membership to
   2670   1.94    rpaulo 			 *  drop by matching the multicast address only.
   2671   1.94    rpaulo 			 * On the other hand, we cannot disambiguate the scope
   2672   1.94    rpaulo 			 * zone unless an interface is provided.  Thus, we
   2673   1.94    rpaulo 			 * check if there's ambiguity with the default scope
   2674   1.94    rpaulo 			 * zone as the last resort.
   2675   1.94    rpaulo 			 */
   2676  1.132    plunky 			sockaddr_in6_init(&sa6_mc, &mreq.ipv6mr_multiaddr,
   2677  1.123    dyoung 			    0, 0, 0);
   2678   1.94    rpaulo 			error = sa6_embedscope(&sa6_mc, ip6_use_defzone);
   2679   1.94    rpaulo 			if (error != 0)
   2680   1.94    rpaulo 				break;
   2681  1.132    plunky 			mreq.ipv6mr_multiaddr = sa6_mc.sin6_addr;
   2682    1.2    itojun 		}
   2683   1.94    rpaulo 
   2684    1.2    itojun 		/*
   2685    1.2    itojun 		 * Find the membership in the membership list.
   2686    1.2    itojun 		 */
   2687  1.188     ozaki 		LIST_FOREACH(imm, &im6o->im6o_memberships, i6mm_chain) {
   2688   1.49    itojun 			if ((ifp == NULL || imm->i6mm_maddr->in6m_ifp == ifp) &&
   2689    1.2    itojun 			    IN6_ARE_ADDR_EQUAL(&imm->i6mm_maddr->in6m_addr,
   2690  1.132    plunky 			    &mreq.ipv6mr_multiaddr))
   2691    1.2    itojun 				break;
   2692    1.2    itojun 		}
   2693    1.2    itojun 		if (imm == NULL) {
   2694    1.2    itojun 			/* Unable to resolve interface */
   2695    1.2    itojun 			error = EADDRNOTAVAIL;
   2696    1.2    itojun 			break;
   2697    1.2    itojun 		}
   2698    1.2    itojun 		/*
   2699    1.2    itojun 		 * Give up the multicast address record to which the
   2700    1.2    itojun 		 * membership points.
   2701    1.2    itojun 		 */
   2702    1.2    itojun 		LIST_REMOVE(imm, i6mm_chain);
   2703  1.196     ozaki 		in6m_ifp = imm->i6mm_maddr->in6m_ifp;
   2704  1.196     ozaki 		IFNET_LOCK(in6m_ifp);
   2705   1.43    itojun 		in6_leavegroup(imm);
   2706  1.196     ozaki 		/* in6m_ifp should not leave thanks to in6p_lock */
   2707  1.196     ozaki 		IFNET_UNLOCK(in6m_ifp);
   2708    1.2    itojun 		break;
   2709  1.196     ozaki 	    }
   2710    1.2    itojun 
   2711    1.2    itojun 	default:
   2712    1.2    itojun 		error = EOPNOTSUPP;
   2713    1.2    itojun 		break;
   2714    1.2    itojun 	}
   2715    1.2    itojun 
   2716    1.2    itojun 	/*
   2717    1.2    itojun 	 * If all options have default values, no need to keep the mbuf.
   2718    1.2    itojun 	 */
   2719  1.168     ozaki 	if (im6o->im6o_multicast_if_index == 0 &&
   2720    1.2    itojun 	    im6o->im6o_multicast_hlim == ip6_defmcasthlim &&
   2721    1.2    itojun 	    im6o->im6o_multicast_loop == IPV6_DEFAULT_MULTICAST_LOOP &&
   2722  1.188     ozaki 	    LIST_EMPTY(&im6o->im6o_memberships)) {
   2723  1.160  christos 		free(in6p->in6p_moptions, M_IPMOPTS);
   2724  1.160  christos 		in6p->in6p_moptions = NULL;
   2725    1.2    itojun 	}
   2726    1.2    itojun 
   2727   1.57    itojun 	return (error);
   2728    1.2    itojun }
   2729    1.2    itojun 
   2730    1.2    itojun /*
   2731    1.2    itojun  * Return the IP6 multicast options in response to user getsockopt().
   2732    1.2    itojun  */
   2733    1.2    itojun static int
   2734  1.160  christos ip6_getmoptions(struct sockopt *sopt, struct in6pcb *in6p)
   2735    1.2    itojun {
   2736  1.132    plunky 	u_int optval;
   2737  1.132    plunky 	int error;
   2738  1.160  christos 	struct ip6_moptions *im6o = in6p->in6p_moptions;
   2739    1.2    itojun 
   2740  1.132    plunky 	switch (sopt->sopt_name) {
   2741    1.2    itojun 	case IPV6_MULTICAST_IF:
   2742  1.168     ozaki 		if (im6o == NULL || im6o->im6o_multicast_if_index == 0)
   2743  1.132    plunky 			optval = 0;
   2744    1.2    itojun 		else
   2745  1.168     ozaki 			optval = im6o->im6o_multicast_if_index;
   2746  1.132    plunky 
   2747  1.132    plunky 		error = sockopt_set(sopt, &optval, sizeof(optval));
   2748  1.132    plunky 		break;
   2749    1.2    itojun 
   2750    1.2    itojun 	case IPV6_MULTICAST_HOPS:
   2751    1.2    itojun 		if (im6o == NULL)
   2752  1.132    plunky 			optval = ip6_defmcasthlim;
   2753    1.2    itojun 		else
   2754  1.132    plunky 			optval = im6o->im6o_multicast_hlim;
   2755  1.132    plunky 
   2756  1.132    plunky 		error = sockopt_set(sopt, &optval, sizeof(optval));
   2757  1.132    plunky 		break;
   2758    1.2    itojun 
   2759    1.2    itojun 	case IPV6_MULTICAST_LOOP:
   2760    1.2    itojun 		if (im6o == NULL)
   2761  1.151    kefren 			optval = IPV6_DEFAULT_MULTICAST_LOOP;
   2762    1.2    itojun 		else
   2763  1.132    plunky 			optval = im6o->im6o_multicast_loop;
   2764  1.132    plunky 
   2765  1.132    plunky 		error = sockopt_set(sopt, &optval, sizeof(optval));
   2766  1.132    plunky 		break;
   2767    1.2    itojun 
   2768    1.2    itojun 	default:
   2769  1.132    plunky 		error = EOPNOTSUPP;
   2770    1.2    itojun 	}
   2771  1.132    plunky 
   2772  1.132    plunky 	return (error);
   2773    1.2    itojun }
   2774    1.2    itojun 
   2775    1.2    itojun /*
   2776    1.2    itojun  * Discard the IP6 multicast options.
   2777    1.2    itojun  */
   2778    1.2    itojun void
   2779  1.119  christos ip6_freemoptions(struct ip6_moptions *im6o)
   2780    1.2    itojun {
   2781  1.188     ozaki 	struct in6_multi_mship *imm, *nimm;
   2782    1.2    itojun 
   2783    1.2    itojun 	if (im6o == NULL)
   2784    1.2    itojun 		return;
   2785    1.2    itojun 
   2786  1.190     ozaki 	/* The owner of im6o (in6p) should be protected by solock */
   2787  1.188     ozaki 	LIST_FOREACH_SAFE(imm, &im6o->im6o_memberships, i6mm_chain, nimm) {
   2788  1.196     ozaki 		struct ifnet *ifp;
   2789  1.196     ozaki 
   2790    1.2    itojun 		LIST_REMOVE(imm, i6mm_chain);
   2791  1.196     ozaki 
   2792  1.196     ozaki 		ifp = imm->i6mm_maddr->in6m_ifp;
   2793  1.196     ozaki 		IFNET_LOCK(ifp);
   2794   1.43    itojun 		in6_leavegroup(imm);
   2795  1.196     ozaki 		/* ifp should not leave thanks to solock */
   2796  1.196     ozaki 		IFNET_UNLOCK(ifp);
   2797    1.2    itojun 	}
   2798    1.2    itojun 	free(im6o, M_IPMOPTS);
   2799    1.2    itojun }
   2800    1.2    itojun 
   2801    1.2    itojun /*
   2802    1.2    itojun  * Set IPv6 outgoing packet options based on advanced API.
   2803    1.2    itojun  */
   2804    1.2    itojun int
   2805  1.197      maxv ip6_setpktopts(struct mbuf *control, struct ip6_pktopts *opt,
   2806  1.138      elad 	struct ip6_pktopts *stickyopt, kauth_cred_t cred, int uproto)
   2807    1.2    itojun {
   2808   1.31    itojun 	struct cmsghdr *cm = 0;
   2809    1.2    itojun 
   2810   1.97    rpaulo 	if (control == NULL || opt == NULL)
   2811   1.57    itojun 		return (EINVAL);
   2812    1.2    itojun 
   2813   1.97    rpaulo 	ip6_initpktopts(opt);
   2814   1.97    rpaulo 	if (stickyopt) {
   2815   1.97    rpaulo 		int error;
   2816   1.97    rpaulo 
   2817   1.97    rpaulo 		/*
   2818   1.97    rpaulo 		 * If stickyopt is provided, make a local copy of the options
   2819   1.97    rpaulo 		 * for this particular packet, then override them by ancillary
   2820   1.97    rpaulo 		 * objects.
   2821   1.97    rpaulo 		 * XXX: copypktopts() does not copy the cached route to a next
   2822   1.97    rpaulo 		 * hop (if any).  This is not very good in terms of efficiency,
   2823   1.97    rpaulo 		 * but we can allow this since this option should be rarely
   2824   1.97    rpaulo 		 * used.
   2825   1.97    rpaulo 		 */
   2826   1.97    rpaulo 		if ((error = copypktopts(opt, stickyopt, M_NOWAIT)) != 0)
   2827   1.97    rpaulo 			return (error);
   2828   1.97    rpaulo 	}
   2829    1.2    itojun 
   2830    1.2    itojun 	/*
   2831    1.2    itojun 	 * XXX: Currently, we assume all the optional information is stored
   2832    1.2    itojun 	 * in a single mbuf.
   2833    1.2    itojun 	 */
   2834    1.2    itojun 	if (control->m_next)
   2835   1.57    itojun 		return (EINVAL);
   2836    1.2    itojun 
   2837  1.137  drochner 	/* XXX if cm->cmsg_len is not aligned, control->m_len can become <0 */
   2838  1.137  drochner 	for (; control->m_len > 0; control->m_data += CMSG_ALIGN(cm->cmsg_len),
   2839   1.49    itojun 	    control->m_len -= CMSG_ALIGN(cm->cmsg_len)) {
   2840   1.97    rpaulo 		int error;
   2841   1.97    rpaulo 
   2842   1.97    rpaulo 		if (control->m_len < CMSG_LEN(0))
   2843   1.97    rpaulo 			return (EINVAL);
   2844   1.97    rpaulo 
   2845    1.2    itojun 		cm = mtod(control, struct cmsghdr *);
   2846    1.2    itojun 		if (cm->cmsg_len == 0 || cm->cmsg_len > control->m_len)
   2847   1.57    itojun 			return (EINVAL);
   2848    1.2    itojun 		if (cm->cmsg_level != IPPROTO_IPV6)
   2849    1.2    itojun 			continue;
   2850    1.2    itojun 
   2851   1.97    rpaulo 		error = ip6_setpktopt(cm->cmsg_type, CMSG_DATA(cm),
   2852  1.138      elad 		    cm->cmsg_len - CMSG_LEN(0), opt, cred, 0, 1, uproto);
   2853   1.97    rpaulo 		if (error)
   2854   1.97    rpaulo 			return (error);
   2855   1.97    rpaulo 	}
   2856   1.97    rpaulo 
   2857   1.97    rpaulo 	return (0);
   2858   1.97    rpaulo }
   2859   1.97    rpaulo 
   2860   1.97    rpaulo /*
   2861   1.97    rpaulo  * Set a particular packet option, as a sticky option or an ancillary data
   2862   1.97    rpaulo  * item.  "len" can be 0 only when it's a sticky option.
   2863   1.97    rpaulo  * We have 4 cases of combination of "sticky" and "cmsg":
   2864   1.97    rpaulo  * "sticky=0, cmsg=0": impossible
   2865   1.97    rpaulo  * "sticky=0, cmsg=1": RFC2292 or RFC3542 ancillary data
   2866   1.97    rpaulo  * "sticky=1, cmsg=0": RFC3542 socket option
   2867   1.97    rpaulo  * "sticky=1, cmsg=1": RFC2292 socket option
   2868   1.97    rpaulo  */
   2869   1.97    rpaulo static int
   2870   1.97    rpaulo ip6_setpktopt(int optname, u_char *buf, int len, struct ip6_pktopts *opt,
   2871  1.138      elad     kauth_cred_t cred, int sticky, int cmsg, int uproto)
   2872   1.97    rpaulo {
   2873   1.97    rpaulo 	int minmtupolicy;
   2874  1.139      elad 	int error;
   2875   1.97    rpaulo 
   2876   1.97    rpaulo 	if (!sticky && !cmsg) {
   2877   1.97    rpaulo #ifdef DIAGNOSTIC
   2878   1.97    rpaulo 		printf("ip6_setpktopt: impossible case\n");
   2879   1.97    rpaulo #endif
   2880   1.97    rpaulo 		return (EINVAL);
   2881   1.97    rpaulo 	}
   2882   1.97    rpaulo 
   2883   1.97    rpaulo 	/*
   2884   1.97    rpaulo 	 * IPV6_2292xxx is for backward compatibility to RFC2292, and should
   2885   1.97    rpaulo 	 * not be specified in the context of RFC3542.  Conversely,
   2886   1.97    rpaulo 	 * RFC3542 types should not be specified in the context of RFC2292.
   2887   1.97    rpaulo 	 */
   2888   1.97    rpaulo 	if (!cmsg) {
   2889   1.97    rpaulo 		switch (optname) {
   2890   1.97    rpaulo 		case IPV6_2292PKTINFO:
   2891   1.97    rpaulo 		case IPV6_2292HOPLIMIT:
   2892   1.97    rpaulo 		case IPV6_2292NEXTHOP:
   2893   1.97    rpaulo 		case IPV6_2292HOPOPTS:
   2894   1.97    rpaulo 		case IPV6_2292DSTOPTS:
   2895   1.97    rpaulo 		case IPV6_2292RTHDR:
   2896   1.97    rpaulo 		case IPV6_2292PKTOPTIONS:
   2897   1.97    rpaulo 			return (ENOPROTOOPT);
   2898   1.97    rpaulo 		}
   2899   1.97    rpaulo 	}
   2900   1.97    rpaulo 	if (sticky && cmsg) {
   2901   1.97    rpaulo 		switch (optname) {
   2902    1.2    itojun 		case IPV6_PKTINFO:
   2903   1.97    rpaulo 		case IPV6_HOPLIMIT:
   2904   1.97    rpaulo 		case IPV6_NEXTHOP:
   2905   1.97    rpaulo 		case IPV6_HOPOPTS:
   2906   1.97    rpaulo 		case IPV6_DSTOPTS:
   2907   1.97    rpaulo 		case IPV6_RTHDRDSTOPTS:
   2908   1.97    rpaulo 		case IPV6_RTHDR:
   2909   1.97    rpaulo 		case IPV6_USE_MIN_MTU:
   2910   1.97    rpaulo 		case IPV6_DONTFRAG:
   2911   1.97    rpaulo 		case IPV6_OTCLASS:
   2912   1.97    rpaulo 		case IPV6_TCLASS:
   2913  1.161       roy 		case IPV6_PREFER_TEMPADDR: /* XXX not an RFC3542 option */
   2914   1.97    rpaulo 			return (ENOPROTOOPT);
   2915   1.97    rpaulo 		}
   2916   1.97    rpaulo 	}
   2917   1.97    rpaulo 
   2918   1.97    rpaulo 	switch (optname) {
   2919   1.97    rpaulo #ifdef RFC2292
   2920   1.97    rpaulo 	case IPV6_2292PKTINFO:
   2921   1.97    rpaulo #endif
   2922   1.97    rpaulo 	case IPV6_PKTINFO:
   2923   1.97    rpaulo 	{
   2924   1.97    rpaulo 		struct in6_pktinfo *pktinfo;
   2925   1.97    rpaulo 
   2926   1.97    rpaulo 		if (len != sizeof(struct in6_pktinfo))
   2927   1.97    rpaulo 			return (EINVAL);
   2928   1.97    rpaulo 
   2929   1.97    rpaulo 		pktinfo = (struct in6_pktinfo *)buf;
   2930   1.97    rpaulo 
   2931   1.97    rpaulo 		/*
   2932   1.97    rpaulo 		 * An application can clear any sticky IPV6_PKTINFO option by
   2933   1.97    rpaulo 		 * doing a "regular" setsockopt with ipi6_addr being
   2934   1.97    rpaulo 		 * in6addr_any and ipi6_ifindex being zero.
   2935   1.97    rpaulo 		 * [RFC 3542, Section 6]
   2936   1.97    rpaulo 		 */
   2937   1.97    rpaulo 		if (optname == IPV6_PKTINFO && opt->ip6po_pktinfo &&
   2938   1.97    rpaulo 		    pktinfo->ipi6_ifindex == 0 &&
   2939   1.97    rpaulo 		    IN6_IS_ADDR_UNSPECIFIED(&pktinfo->ipi6_addr)) {
   2940   1.97    rpaulo 			ip6_clearpktopts(opt, optname);
   2941   1.97    rpaulo 			break;
   2942   1.97    rpaulo 		}
   2943   1.97    rpaulo 
   2944   1.97    rpaulo 		if (uproto == IPPROTO_TCP && optname == IPV6_PKTINFO &&
   2945   1.97    rpaulo 		    sticky && !IN6_IS_ADDR_UNSPECIFIED(&pktinfo->ipi6_addr)) {
   2946   1.97    rpaulo 			return (EINVAL);
   2947   1.97    rpaulo 		}
   2948   1.97    rpaulo 
   2949  1.156     rmind 		/* Validate the interface index if specified. */
   2950   1.97    rpaulo 		if (pktinfo->ipi6_ifindex) {
   2951  1.169     ozaki 			struct ifnet *ifp;
   2952  1.169     ozaki 			int s = pserialize_read_enter();
   2953  1.156     rmind 			ifp = if_byindex(pktinfo->ipi6_ifindex);
   2954  1.169     ozaki 			if (ifp == NULL) {
   2955  1.169     ozaki 				pserialize_read_exit(s);
   2956  1.169     ozaki 				return ENXIO;
   2957  1.169     ozaki 			}
   2958  1.169     ozaki 			pserialize_read_exit(s);
   2959   1.97    rpaulo 		}
   2960   1.97    rpaulo 
   2961   1.97    rpaulo 		/*
   2962   1.97    rpaulo 		 * We store the address anyway, and let in6_selectsrc()
   2963   1.97    rpaulo 		 * validate the specified address.  This is because ipi6_addr
   2964   1.97    rpaulo 		 * may not have enough information about its scope zone, and
   2965   1.97    rpaulo 		 * we may need additional information (such as outgoing
   2966   1.97    rpaulo 		 * interface or the scope zone of a destination address) to
   2967   1.97    rpaulo 		 * disambiguate the scope.
   2968   1.97    rpaulo 		 * XXX: the delay of the validation may confuse the
   2969   1.97    rpaulo 		 * application when it is used as a sticky option.
   2970   1.97    rpaulo 		 */
   2971   1.97    rpaulo 		if (opt->ip6po_pktinfo == NULL) {
   2972   1.97    rpaulo 			opt->ip6po_pktinfo = malloc(sizeof(*pktinfo),
   2973   1.97    rpaulo 			    M_IP6OPT, M_NOWAIT);
   2974   1.97    rpaulo 			if (opt->ip6po_pktinfo == NULL)
   2975   1.97    rpaulo 				return (ENOBUFS);
   2976   1.97    rpaulo 		}
   2977   1.97    rpaulo 		memcpy(opt->ip6po_pktinfo, pktinfo, sizeof(*pktinfo));
   2978   1.97    rpaulo 		break;
   2979   1.97    rpaulo 	}
   2980   1.97    rpaulo 
   2981   1.97    rpaulo #ifdef RFC2292
   2982   1.97    rpaulo 	case IPV6_2292HOPLIMIT:
   2983   1.97    rpaulo #endif
   2984   1.97    rpaulo 	case IPV6_HOPLIMIT:
   2985   1.97    rpaulo 	{
   2986   1.97    rpaulo 		int *hlimp;
   2987   1.97    rpaulo 
   2988   1.97    rpaulo 		/*
   2989   1.97    rpaulo 		 * RFC 3542 deprecated the usage of sticky IPV6_HOPLIMIT
   2990   1.97    rpaulo 		 * to simplify the ordering among hoplimit options.
   2991   1.97    rpaulo 		 */
   2992   1.97    rpaulo 		if (optname == IPV6_HOPLIMIT && sticky)
   2993   1.97    rpaulo 			return (ENOPROTOOPT);
   2994   1.97    rpaulo 
   2995   1.97    rpaulo 		if (len != sizeof(int))
   2996   1.97    rpaulo 			return (EINVAL);
   2997   1.97    rpaulo 		hlimp = (int *)buf;
   2998   1.97    rpaulo 		if (*hlimp < -1 || *hlimp > 255)
   2999   1.97    rpaulo 			return (EINVAL);
   3000   1.97    rpaulo 
   3001   1.97    rpaulo 		opt->ip6po_hlim = *hlimp;
   3002   1.97    rpaulo 		break;
   3003   1.97    rpaulo 	}
   3004   1.97    rpaulo 
   3005   1.97    rpaulo 	case IPV6_OTCLASS:
   3006   1.97    rpaulo 		if (len != sizeof(u_int8_t))
   3007   1.97    rpaulo 			return (EINVAL);
   3008   1.97    rpaulo 
   3009   1.97    rpaulo 		opt->ip6po_tclass = *(u_int8_t *)buf;
   3010   1.97    rpaulo 		break;
   3011   1.97    rpaulo 
   3012   1.97    rpaulo 	case IPV6_TCLASS:
   3013   1.97    rpaulo 	{
   3014   1.97    rpaulo 		int tclass;
   3015   1.97    rpaulo 
   3016   1.97    rpaulo 		if (len != sizeof(int))
   3017   1.97    rpaulo 			return (EINVAL);
   3018   1.97    rpaulo 		tclass = *(int *)buf;
   3019   1.97    rpaulo 		if (tclass < -1 || tclass > 255)
   3020   1.97    rpaulo 			return (EINVAL);
   3021    1.2    itojun 
   3022   1.97    rpaulo 		opt->ip6po_tclass = tclass;
   3023   1.97    rpaulo 		break;
   3024   1.97    rpaulo 	}
   3025   1.94    rpaulo 
   3026   1.97    rpaulo #ifdef RFC2292
   3027   1.97    rpaulo 	case IPV6_2292NEXTHOP:
   3028   1.97    rpaulo #endif
   3029   1.97    rpaulo 	case IPV6_NEXTHOP:
   3030  1.146      elad 		error = kauth_authorize_network(cred, KAUTH_NETWORK_IPV6,
   3031  1.146      elad 		    KAUTH_REQ_NETWORK_IPV6_HOPBYHOP, NULL, NULL, NULL);
   3032  1.139      elad 		if (error)
   3033  1.139      elad 			return (error);
   3034   1.35    itojun 
   3035   1.97    rpaulo 		if (len == 0) {	/* just remove the option */
   3036   1.97    rpaulo 			ip6_clearpktopts(opt, IPV6_NEXTHOP);
   3037    1.2    itojun 			break;
   3038   1.97    rpaulo 		}
   3039   1.97    rpaulo 
   3040   1.97    rpaulo 		/* check if cmsg_len is large enough for sa_len */
   3041   1.97    rpaulo 		if (len < sizeof(struct sockaddr) || len < *buf)
   3042   1.97    rpaulo 			return (EINVAL);
   3043   1.97    rpaulo 
   3044   1.97    rpaulo 		switch (((struct sockaddr *)buf)->sa_family) {
   3045   1.97    rpaulo 		case AF_INET6:
   3046   1.97    rpaulo 		{
   3047   1.97    rpaulo 			struct sockaddr_in6 *sa6 = (struct sockaddr_in6 *)buf;
   3048    1.2    itojun 
   3049   1.97    rpaulo 			if (sa6->sin6_len != sizeof(struct sockaddr_in6))
   3050   1.57    itojun 				return (EINVAL);
   3051    1.2    itojun 
   3052   1.97    rpaulo 			if (IN6_IS_ADDR_UNSPECIFIED(&sa6->sin6_addr) ||
   3053   1.97    rpaulo 			    IN6_IS_ADDR_MULTICAST(&sa6->sin6_addr)) {
   3054   1.97    rpaulo 				return (EINVAL);
   3055   1.97    rpaulo 			}
   3056   1.97    rpaulo 			if ((error = sa6_embedscope(sa6, ip6_use_defzone))
   3057   1.97    rpaulo 			    != 0) {
   3058   1.97    rpaulo 				return (error);
   3059   1.67    itojun 			}
   3060    1.2    itojun 			break;
   3061   1.97    rpaulo 		}
   3062   1.97    rpaulo 		case AF_LINK:	/* eventually be supported? */
   3063   1.97    rpaulo 		default:
   3064   1.97    rpaulo 			return (EAFNOSUPPORT);
   3065   1.97    rpaulo 		}
   3066    1.2    itojun 
   3067   1.97    rpaulo 		/* turn off the previous option, then set the new option. */
   3068   1.97    rpaulo 		ip6_clearpktopts(opt, IPV6_NEXTHOP);
   3069   1.97    rpaulo 		opt->ip6po_nexthop = malloc(*buf, M_IP6OPT, M_NOWAIT);
   3070   1.97    rpaulo 		if (opt->ip6po_nexthop == NULL)
   3071   1.97    rpaulo 			return (ENOBUFS);
   3072   1.97    rpaulo 		memcpy(opt->ip6po_nexthop, buf, *buf);
   3073   1.97    rpaulo 		break;
   3074   1.97    rpaulo 
   3075   1.97    rpaulo #ifdef RFC2292
   3076   1.97    rpaulo 	case IPV6_2292HOPOPTS:
   3077   1.97    rpaulo #endif
   3078   1.97    rpaulo 	case IPV6_HOPOPTS:
   3079   1.97    rpaulo 	{
   3080   1.97    rpaulo 		struct ip6_hbh *hbh;
   3081   1.97    rpaulo 		int hbhlen;
   3082   1.97    rpaulo 
   3083   1.97    rpaulo 		/*
   3084   1.97    rpaulo 		 * XXX: We don't allow a non-privileged user to set ANY HbH
   3085   1.97    rpaulo 		 * options, since per-option restriction has too much
   3086   1.97    rpaulo 		 * overhead.
   3087   1.97    rpaulo 		 */
   3088  1.146      elad 		error = kauth_authorize_network(cred, KAUTH_NETWORK_IPV6,
   3089  1.146      elad 		    KAUTH_REQ_NETWORK_IPV6_HOPBYHOP, NULL, NULL, NULL);
   3090  1.139      elad 		if (error)
   3091  1.139      elad 			return (error);
   3092   1.97    rpaulo 
   3093   1.97    rpaulo 		if (len == 0) {
   3094   1.97    rpaulo 			ip6_clearpktopts(opt, IPV6_HOPOPTS);
   3095   1.97    rpaulo 			break;	/* just remove the option */
   3096   1.97    rpaulo 		}
   3097   1.31    itojun 
   3098   1.97    rpaulo 		/* message length validation */
   3099   1.97    rpaulo 		if (len < sizeof(struct ip6_hbh))
   3100   1.97    rpaulo 			return (EINVAL);
   3101   1.97    rpaulo 		hbh = (struct ip6_hbh *)buf;
   3102   1.97    rpaulo 		hbhlen = (hbh->ip6h_len + 1) << 3;
   3103   1.97    rpaulo 		if (len != hbhlen)
   3104   1.97    rpaulo 			return (EINVAL);
   3105    1.2    itojun 
   3106   1.97    rpaulo 		/* turn off the previous option, then set the new option. */
   3107   1.97    rpaulo 		ip6_clearpktopts(opt, IPV6_HOPOPTS);
   3108   1.97    rpaulo 		opt->ip6po_hbh = malloc(hbhlen, M_IP6OPT, M_NOWAIT);
   3109   1.97    rpaulo 		if (opt->ip6po_hbh == NULL)
   3110   1.97    rpaulo 			return (ENOBUFS);
   3111   1.97    rpaulo 		memcpy(opt->ip6po_hbh, hbh, hbhlen);
   3112    1.2    itojun 
   3113   1.97    rpaulo 		break;
   3114   1.97    rpaulo 	}
   3115    1.2    itojun 
   3116   1.97    rpaulo #ifdef RFC2292
   3117   1.97    rpaulo 	case IPV6_2292DSTOPTS:
   3118   1.97    rpaulo #endif
   3119   1.97    rpaulo 	case IPV6_DSTOPTS:
   3120   1.97    rpaulo 	case IPV6_RTHDRDSTOPTS:
   3121   1.97    rpaulo 	{
   3122   1.97    rpaulo 		struct ip6_dest *dest, **newdest = NULL;
   3123   1.97    rpaulo 		int destlen;
   3124   1.67    itojun 
   3125  1.139      elad 		/* XXX: see the comment for IPV6_HOPOPTS */
   3126  1.146      elad 		error = kauth_authorize_network(cred, KAUTH_NETWORK_IPV6,
   3127  1.146      elad 		    KAUTH_REQ_NETWORK_IPV6_HOPBYHOP, NULL, NULL, NULL);
   3128  1.139      elad 		if (error)
   3129  1.139      elad 			return (error);
   3130    1.2    itojun 
   3131   1.97    rpaulo 		if (len == 0) {
   3132   1.97    rpaulo 			ip6_clearpktopts(opt, optname);
   3133   1.97    rpaulo 			break;	/* just remove the option */
   3134   1.97    rpaulo 		}
   3135    1.2    itojun 
   3136   1.97    rpaulo 		/* message length validation */
   3137   1.97    rpaulo 		if (len < sizeof(struct ip6_dest))
   3138   1.97    rpaulo 			return (EINVAL);
   3139   1.97    rpaulo 		dest = (struct ip6_dest *)buf;
   3140   1.97    rpaulo 		destlen = (dest->ip6d_len + 1) << 3;
   3141   1.97    rpaulo 		if (len != destlen)
   3142   1.97    rpaulo 			return (EINVAL);
   3143   1.97    rpaulo 		/*
   3144   1.97    rpaulo 		 * Determine the position that the destination options header
   3145   1.97    rpaulo 		 * should be inserted; before or after the routing header.
   3146   1.97    rpaulo 		 */
   3147   1.97    rpaulo 		switch (optname) {
   3148   1.97    rpaulo 		case IPV6_2292DSTOPTS:
   3149    1.2    itojun 			/*
   3150   1.97    rpaulo 			 * The old advanced API is ambiguous on this point.
   3151   1.97    rpaulo 			 * Our approach is to determine the position based
   3152   1.97    rpaulo 			 * according to the existence of a routing header.
   3153   1.97    rpaulo 			 * Note, however, that this depends on the order of the
   3154   1.97    rpaulo 			 * extension headers in the ancillary data; the 1st
   3155   1.97    rpaulo 			 * part of the destination options header must appear
   3156   1.97    rpaulo 			 * before the routing header in the ancillary data,
   3157   1.97    rpaulo 			 * too.
   3158   1.97    rpaulo 			 * RFC3542 solved the ambiguity by introducing
   3159   1.97    rpaulo 			 * separate ancillary data or option types.
   3160    1.2    itojun 			 */
   3161   1.97    rpaulo 			if (opt->ip6po_rthdr == NULL)
   3162   1.97    rpaulo 				newdest = &opt->ip6po_dest1;
   3163   1.97    rpaulo 			else
   3164   1.97    rpaulo 				newdest = &opt->ip6po_dest2;
   3165   1.97    rpaulo 			break;
   3166   1.97    rpaulo 		case IPV6_RTHDRDSTOPTS:
   3167   1.97    rpaulo 			newdest = &opt->ip6po_dest1;
   3168   1.97    rpaulo 			break;
   3169   1.97    rpaulo 		case IPV6_DSTOPTS:
   3170   1.97    rpaulo 			newdest = &opt->ip6po_dest2;
   3171   1.97    rpaulo 			break;
   3172   1.97    rpaulo 		}
   3173   1.97    rpaulo 
   3174   1.97    rpaulo 		/* turn off the previous option, then set the new option. */
   3175   1.97    rpaulo 		ip6_clearpktopts(opt, optname);
   3176   1.97    rpaulo 		*newdest = malloc(destlen, M_IP6OPT, M_NOWAIT);
   3177   1.97    rpaulo 		if (*newdest == NULL)
   3178   1.97    rpaulo 			return (ENOBUFS);
   3179   1.97    rpaulo 		memcpy(*newdest, dest, destlen);
   3180   1.67    itojun 
   3181   1.97    rpaulo 		break;
   3182   1.97    rpaulo 	}
   3183   1.97    rpaulo 
   3184   1.97    rpaulo #ifdef RFC2292
   3185   1.97    rpaulo 	case IPV6_2292RTHDR:
   3186   1.97    rpaulo #endif
   3187   1.97    rpaulo 	case IPV6_RTHDR:
   3188   1.97    rpaulo 	{
   3189   1.97    rpaulo 		struct ip6_rthdr *rth;
   3190   1.97    rpaulo 		int rthlen;
   3191   1.97    rpaulo 
   3192   1.97    rpaulo 		if (len == 0) {
   3193   1.97    rpaulo 			ip6_clearpktopts(opt, IPV6_RTHDR);
   3194   1.97    rpaulo 			break;	/* just remove the option */
   3195   1.97    rpaulo 		}
   3196    1.2    itojun 
   3197   1.97    rpaulo 		/* message length validation */
   3198   1.97    rpaulo 		if (len < sizeof(struct ip6_rthdr))
   3199   1.97    rpaulo 			return (EINVAL);
   3200   1.97    rpaulo 		rth = (struct ip6_rthdr *)buf;
   3201   1.97    rpaulo 		rthlen = (rth->ip6r_len + 1) << 3;
   3202   1.97    rpaulo 		if (len != rthlen)
   3203   1.97    rpaulo 			return (EINVAL);
   3204   1.97    rpaulo 		switch (rth->ip6r_type) {
   3205   1.97    rpaulo 		case IPV6_RTHDR_TYPE_0:
   3206   1.97    rpaulo 			if (rth->ip6r_len == 0)	/* must contain one addr */
   3207   1.97    rpaulo 				return (EINVAL);
   3208   1.97    rpaulo 			if (rth->ip6r_len % 2) /* length must be even */
   3209   1.97    rpaulo 				return (EINVAL);
   3210   1.97    rpaulo 			if (rth->ip6r_len / 2 != rth->ip6r_segleft)
   3211   1.57    itojun 				return (EINVAL);
   3212    1.2    itojun 			break;
   3213    1.2    itojun 		default:
   3214   1.97    rpaulo 			return (EINVAL);	/* not supported */
   3215    1.2    itojun 		}
   3216   1.97    rpaulo 		/* turn off the previous option */
   3217   1.97    rpaulo 		ip6_clearpktopts(opt, IPV6_RTHDR);
   3218   1.97    rpaulo 		opt->ip6po_rthdr = malloc(rthlen, M_IP6OPT, M_NOWAIT);
   3219   1.97    rpaulo 		if (opt->ip6po_rthdr == NULL)
   3220   1.97    rpaulo 			return (ENOBUFS);
   3221   1.97    rpaulo 		memcpy(opt->ip6po_rthdr, rth, rthlen);
   3222   1.97    rpaulo 		break;
   3223    1.2    itojun 	}
   3224    1.2    itojun 
   3225   1.97    rpaulo 	case IPV6_USE_MIN_MTU:
   3226   1.97    rpaulo 		if (len != sizeof(int))
   3227   1.97    rpaulo 			return (EINVAL);
   3228   1.97    rpaulo 		minmtupolicy = *(int *)buf;
   3229   1.97    rpaulo 		if (minmtupolicy != IP6PO_MINMTU_MCASTONLY &&
   3230   1.97    rpaulo 		    minmtupolicy != IP6PO_MINMTU_DISABLE &&
   3231   1.97    rpaulo 		    minmtupolicy != IP6PO_MINMTU_ALL) {
   3232   1.97    rpaulo 			return (EINVAL);
   3233   1.97    rpaulo 		}
   3234   1.97    rpaulo 		opt->ip6po_minmtu = minmtupolicy;
   3235   1.97    rpaulo 		break;
   3236   1.97    rpaulo 
   3237   1.97    rpaulo 	case IPV6_DONTFRAG:
   3238   1.97    rpaulo 		if (len != sizeof(int))
   3239   1.97    rpaulo 			return (EINVAL);
   3240   1.97    rpaulo 
   3241   1.97    rpaulo 		if (uproto == IPPROTO_TCP || *(int *)buf == 0) {
   3242   1.97    rpaulo 			/*
   3243   1.97    rpaulo 			 * we ignore this option for TCP sockets.
   3244   1.97    rpaulo 			 * (RFC3542 leaves this case unspecified.)
   3245   1.97    rpaulo 			 */
   3246   1.97    rpaulo 			opt->ip6po_flags &= ~IP6PO_DONTFRAG;
   3247   1.97    rpaulo 		} else
   3248   1.97    rpaulo 			opt->ip6po_flags |= IP6PO_DONTFRAG;
   3249   1.97    rpaulo 		break;
   3250   1.97    rpaulo 
   3251  1.161       roy 	case IPV6_PREFER_TEMPADDR:
   3252  1.161       roy 	{
   3253  1.161       roy 		int preftemp;
   3254  1.161       roy 
   3255  1.161       roy 		if (len != sizeof(int))
   3256  1.161       roy 			return (EINVAL);
   3257  1.161       roy 		preftemp = *(int *)buf;
   3258  1.161       roy 		switch (preftemp) {
   3259  1.161       roy 		case IP6PO_TEMPADDR_SYSTEM:
   3260  1.161       roy 		case IP6PO_TEMPADDR_NOTPREFER:
   3261  1.161       roy 		case IP6PO_TEMPADDR_PREFER:
   3262  1.161       roy 			break;
   3263  1.161       roy 		default:
   3264  1.161       roy 			return (EINVAL);
   3265  1.161       roy 		}
   3266  1.161       roy 		opt->ip6po_prefer_tempaddr = preftemp;
   3267  1.161       roy 		break;
   3268  1.161       roy 	}
   3269  1.161       roy 
   3270   1.97    rpaulo 	default:
   3271   1.97    rpaulo 		return (ENOPROTOOPT);
   3272   1.97    rpaulo 	} /* end of switch */
   3273   1.97    rpaulo 
   3274   1.57    itojun 	return (0);
   3275    1.2    itojun }
   3276    1.2    itojun 
   3277    1.2    itojun /*
   3278    1.2    itojun  * Routine called from ip6_output() to loop back a copy of an IP6 multicast
   3279    1.2    itojun  * packet to the input queue of a specified interface.  Note that this
   3280    1.2    itojun  * calls the output routine of the loopback "driver", but with an interface
   3281   1.86     peter  * pointer that might NOT be lo0ifp -- easier than replicating that code here.
   3282    1.2    itojun  */
   3283    1.2    itojun void
   3284  1.197      maxv ip6_mloopback(struct ifnet *ifp, struct mbuf *m,
   3285  1.119  christos 	const struct sockaddr_in6 *dst)
   3286    1.2    itojun {
   3287   1.22    itojun 	struct mbuf *copym;
   3288   1.22    itojun 	struct ip6_hdr *ip6;
   3289    1.2    itojun 
   3290    1.2    itojun 	copym = m_copy(m, 0, M_COPYALL);
   3291   1.22    itojun 	if (copym == NULL)
   3292   1.22    itojun 		return;
   3293   1.22    itojun 
   3294   1.22    itojun 	/*
   3295   1.22    itojun 	 * Make sure to deep-copy IPv6 header portion in case the data
   3296   1.22    itojun 	 * is in an mbuf cluster, so that we can safely override the IPv6
   3297   1.22    itojun 	 * header portion later.
   3298   1.22    itojun 	 */
   3299   1.22    itojun 	if ((copym->m_flags & M_EXT) != 0 ||
   3300   1.22    itojun 	    copym->m_len < sizeof(struct ip6_hdr)) {
   3301   1.22    itojun 		copym = m_pullup(copym, sizeof(struct ip6_hdr));
   3302   1.22    itojun 		if (copym == NULL)
   3303   1.22    itojun 			return;
   3304   1.22    itojun 	}
   3305   1.22    itojun 
   3306   1.22    itojun #ifdef DIAGNOSTIC
   3307   1.22    itojun 	if (copym->m_len < sizeof(*ip6)) {
   3308   1.22    itojun 		m_freem(copym);
   3309   1.22    itojun 		return;
   3310   1.22    itojun 	}
   3311   1.22    itojun #endif
   3312   1.22    itojun 
   3313   1.34    itojun 	ip6 = mtod(copym, struct ip6_hdr *);
   3314   1.94    rpaulo 	/*
   3315   1.94    rpaulo 	 * clear embedded scope identifiers if necessary.
   3316   1.94    rpaulo 	 * in6_clearscope will touch the addresses only when necessary.
   3317   1.94    rpaulo 	 */
   3318   1.94    rpaulo 	in6_clearscope(&ip6->ip6_src);
   3319   1.94    rpaulo 	in6_clearscope(&ip6->ip6_dst);
   3320   1.22    itojun 
   3321  1.115    dyoung 	(void)looutput(ifp, copym, (const struct sockaddr *)dst, NULL);
   3322    1.2    itojun }
   3323    1.2    itojun 
   3324    1.2    itojun /*
   3325    1.2    itojun  * Chop IPv6 header off from the payload.
   3326    1.2    itojun  */
   3327    1.2    itojun static int
   3328  1.119  christos ip6_splithdr(struct mbuf *m,  struct ip6_exthdrs *exthdrs)
   3329    1.2    itojun {
   3330    1.2    itojun 	struct mbuf *mh;
   3331    1.2    itojun 	struct ip6_hdr *ip6;
   3332    1.2    itojun 
   3333    1.2    itojun 	ip6 = mtod(m, struct ip6_hdr *);
   3334    1.2    itojun 	if (m->m_len > sizeof(*ip6)) {
   3335    1.2    itojun 		MGETHDR(mh, M_DONTWAIT, MT_HEADER);
   3336    1.2    itojun 		if (mh == 0) {
   3337    1.2    itojun 			m_freem(m);
   3338    1.2    itojun 			return ENOBUFS;
   3339    1.2    itojun 		}
   3340   1.91      yamt 		M_MOVE_PKTHDR(mh, m);
   3341    1.2    itojun 		MH_ALIGN(mh, sizeof(*ip6));
   3342    1.2    itojun 		m->m_len -= sizeof(*ip6);
   3343    1.2    itojun 		m->m_data += sizeof(*ip6);
   3344    1.2    itojun 		mh->m_next = m;
   3345    1.2    itojun 		m = mh;
   3346    1.2    itojun 		m->m_len = sizeof(*ip6);
   3347  1.117  christos 		bcopy((void *)ip6, mtod(m, void *), sizeof(*ip6));
   3348    1.2    itojun 	}
   3349    1.2    itojun 	exthdrs->ip6e_ip6 = m;
   3350    1.2    itojun 	return 0;
   3351    1.2    itojun }
   3352    1.2    itojun 
   3353    1.2    itojun /*
   3354    1.2    itojun  * Compute IPv6 extension header length.
   3355    1.2    itojun  */
   3356    1.2    itojun int
   3357  1.119  christos ip6_optlen(struct in6pcb *in6p)
   3358    1.2    itojun {
   3359    1.2    itojun 	int len;
   3360    1.2    itojun 
   3361    1.2    itojun 	if (!in6p->in6p_outputopts)
   3362    1.2    itojun 		return 0;
   3363    1.2    itojun 
   3364    1.2    itojun 	len = 0;
   3365    1.2    itojun #define elen(x) \
   3366    1.2    itojun     (((struct ip6_ext *)(x)) ? (((struct ip6_ext *)(x))->ip6e_len + 1) << 3 : 0)
   3367    1.2    itojun 
   3368    1.2    itojun 	len += elen(in6p->in6p_outputopts->ip6po_hbh);
   3369    1.2    itojun 	len += elen(in6p->in6p_outputopts->ip6po_dest1);
   3370    1.2    itojun 	len += elen(in6p->in6p_outputopts->ip6po_rthdr);
   3371    1.2    itojun 	len += elen(in6p->in6p_outputopts->ip6po_dest2);
   3372    1.2    itojun 	return len;
   3373    1.2    itojun #undef elen
   3374    1.2    itojun }
   3375  1.174       roy 
   3376  1.174       roy /*
   3377  1.174       roy  * Ensure sending address is valid.
   3378  1.174       roy  * Returns 0 on success, -1 if an error should be sent back or 1
   3379  1.174       roy  * if the packet could be dropped without error (protocol dependent).
   3380  1.174       roy  */
   3381  1.174       roy static int
   3382  1.194       roy ip6_ifaddrvalid(const struct in6_addr *src, const struct in6_addr *dst)
   3383  1.174       roy {
   3384  1.174       roy 	struct sockaddr_in6 sin6;
   3385  1.174       roy 	int s, error;
   3386  1.174       roy 	struct ifaddr *ifa;
   3387  1.174       roy 	struct in6_ifaddr *ia6;
   3388  1.174       roy 
   3389  1.194       roy 	if (IN6_IS_ADDR_UNSPECIFIED(src))
   3390  1.174       roy 		return 0;
   3391  1.174       roy 
   3392  1.174       roy 	memset(&sin6, 0, sizeof(sin6));
   3393  1.174       roy 	sin6.sin6_family = AF_INET6;
   3394  1.174       roy 	sin6.sin6_len = sizeof(sin6);
   3395  1.194       roy 	sin6.sin6_addr = *src;
   3396  1.174       roy 
   3397  1.174       roy 	s = pserialize_read_enter();
   3398  1.174       roy 	ifa = ifa_ifwithaddr(sin6tosa(&sin6));
   3399  1.174       roy 	if ((ia6 = ifatoia6(ifa)) == NULL ||
   3400  1.174       roy 	    ia6->ia6_flags & (IN6_IFF_ANYCAST | IN6_IFF_DUPLICATED))
   3401  1.174       roy 		error = -1;
   3402  1.194       roy 	else if (ia6->ia6_flags & IN6_IFF_TENTATIVE)
   3403  1.194       roy 		error = 1;
   3404  1.194       roy 	else if (ia6->ia6_flags & IN6_IFF_DETACHED &&
   3405  1.195       kre 	    (sin6.sin6_addr = *dst, ifa_ifwithaddr(sin6tosa(&sin6)) == NULL))
   3406  1.194       roy 		/* Allow internal traffic to DETACHED addresses */
   3407  1.174       roy 		error = 1;
   3408  1.174       roy 	else
   3409  1.174       roy 		error = 0;
   3410  1.174       roy 	pserialize_read_exit(s);
   3411  1.174       roy 
   3412  1.174       roy 	return error;
   3413  1.174       roy }
   3414