xref: /freebsd/sys/netinet6/ip6_output.c (revision f44270e764dc8b896c138a9d8d19ead6572c3a99)
1caf43b02SWarner Losh /*-
282cd038dSYoshinobu Inoue  * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project.
382cd038dSYoshinobu Inoue  * All rights reserved.
482cd038dSYoshinobu Inoue  *
582cd038dSYoshinobu Inoue  * Redistribution and use in source and binary forms, with or without
682cd038dSYoshinobu Inoue  * modification, are permitted provided that the following conditions
782cd038dSYoshinobu Inoue  * are met:
882cd038dSYoshinobu Inoue  * 1. Redistributions of source code must retain the above copyright
982cd038dSYoshinobu Inoue  *    notice, this list of conditions and the following disclaimer.
1082cd038dSYoshinobu Inoue  * 2. Redistributions in binary form must reproduce the above copyright
1182cd038dSYoshinobu Inoue  *    notice, this list of conditions and the following disclaimer in the
1282cd038dSYoshinobu Inoue  *    documentation and/or other materials provided with the distribution.
1382cd038dSYoshinobu Inoue  * 3. Neither the name of the project nor the names of its contributors
1482cd038dSYoshinobu Inoue  *    may be used to endorse or promote products derived from this software
1582cd038dSYoshinobu Inoue  *    without specific prior written permission.
1682cd038dSYoshinobu Inoue  *
1782cd038dSYoshinobu Inoue  * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
1882cd038dSYoshinobu Inoue  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
1982cd038dSYoshinobu Inoue  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
2082cd038dSYoshinobu Inoue  * ARE DISCLAIMED.  IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
2182cd038dSYoshinobu Inoue  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
2282cd038dSYoshinobu Inoue  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
2382cd038dSYoshinobu Inoue  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
2482cd038dSYoshinobu Inoue  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
2582cd038dSYoshinobu Inoue  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
2682cd038dSYoshinobu Inoue  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
2782cd038dSYoshinobu Inoue  * SUCH DAMAGE.
28b48287a3SDavid E. O'Brien  *
29b48287a3SDavid E. O'Brien  *	$KAME: ip6_output.c,v 1.279 2002/01/26 06:12:30 jinmei Exp $
3082cd038dSYoshinobu Inoue  */
3182cd038dSYoshinobu Inoue 
32caf43b02SWarner Losh /*-
3382cd038dSYoshinobu Inoue  * Copyright (c) 1982, 1986, 1988, 1990, 1993
3482cd038dSYoshinobu Inoue  *	The Regents of the University of California.  All rights reserved.
3582cd038dSYoshinobu Inoue  *
3682cd038dSYoshinobu Inoue  * Redistribution and use in source and binary forms, with or without
3782cd038dSYoshinobu Inoue  * modification, are permitted provided that the following conditions
3882cd038dSYoshinobu Inoue  * are met:
3982cd038dSYoshinobu Inoue  * 1. Redistributions of source code must retain the above copyright
4082cd038dSYoshinobu Inoue  *    notice, this list of conditions and the following disclaimer.
4182cd038dSYoshinobu Inoue  * 2. Redistributions in binary form must reproduce the above copyright
4282cd038dSYoshinobu Inoue  *    notice, this list of conditions and the following disclaimer in the
4382cd038dSYoshinobu Inoue  *    documentation and/or other materials provided with the distribution.
4482cd038dSYoshinobu Inoue  * 4. Neither the name of the University nor the names of its contributors
4582cd038dSYoshinobu Inoue  *    may be used to endorse or promote products derived from this software
4682cd038dSYoshinobu Inoue  *    without specific prior written permission.
4782cd038dSYoshinobu Inoue  *
4882cd038dSYoshinobu Inoue  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
4982cd038dSYoshinobu Inoue  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
5082cd038dSYoshinobu Inoue  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
5182cd038dSYoshinobu Inoue  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
5282cd038dSYoshinobu Inoue  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
5382cd038dSYoshinobu Inoue  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
5482cd038dSYoshinobu Inoue  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
5582cd038dSYoshinobu Inoue  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
5682cd038dSYoshinobu Inoue  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
5782cd038dSYoshinobu Inoue  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
5882cd038dSYoshinobu Inoue  * SUCH DAMAGE.
5982cd038dSYoshinobu Inoue  *
6082cd038dSYoshinobu Inoue  *	@(#)ip_output.c	8.3 (Berkeley) 1/21/94
6182cd038dSYoshinobu Inoue  */
6282cd038dSYoshinobu Inoue 
63b48287a3SDavid E. O'Brien #include <sys/cdefs.h>
64b48287a3SDavid E. O'Brien __FBSDID("$FreeBSD$");
65b48287a3SDavid E. O'Brien 
66686cdd19SJun-ichiro itojun Hagino #include "opt_inet.h"
67686cdd19SJun-ichiro itojun Hagino #include "opt_inet6.h"
68686cdd19SJun-ichiro itojun Hagino #include "opt_ipsec.h"
6933553d6eSBjoern A. Zeeb #include "opt_route.h"
7082cd038dSYoshinobu Inoue 
7182cd038dSYoshinobu Inoue #include <sys/param.h>
72c26fe973SBjoern A. Zeeb #include <sys/kernel.h>
7382cd038dSYoshinobu Inoue #include <sys/malloc.h>
7482cd038dSYoshinobu Inoue #include <sys/mbuf.h>
7582cd038dSYoshinobu Inoue #include <sys/errno.h>
76c2259ba4SRobert Watson #include <sys/priv.h>
77c26fe973SBjoern A. Zeeb #include <sys/proc.h>
7882cd038dSYoshinobu Inoue #include <sys/protosw.h>
7982cd038dSYoshinobu Inoue #include <sys/socket.h>
8082cd038dSYoshinobu Inoue #include <sys/socketvar.h>
811263305fSBjoern A. Zeeb #include <sys/syslog.h>
82c26fe973SBjoern A. Zeeb #include <sys/ucred.h>
83603724d3SBjoern A. Zeeb #include <sys/vimage.h>
8482cd038dSYoshinobu Inoue 
8582cd038dSYoshinobu Inoue #include <net/if.h>
868195404bSBrooks Davis #include <net/netisr.h>
8782cd038dSYoshinobu Inoue #include <net/route.h>
88c4ac87eaSDarren Reed #include <net/pfil.h>
894b79449eSBjoern A. Zeeb #include <net/vnet.h>
9082cd038dSYoshinobu Inoue 
9182cd038dSYoshinobu Inoue #include <netinet/in.h>
9282cd038dSYoshinobu Inoue #include <netinet/in_var.h>
9333841545SHajimu UMEMOTO #include <netinet6/in6_var.h>
94686cdd19SJun-ichiro itojun Hagino #include <netinet/ip6.h>
95686cdd19SJun-ichiro itojun Hagino #include <netinet/icmp6.h>
9682cd038dSYoshinobu Inoue #include <netinet6/ip6_var.h>
97686cdd19SJun-ichiro itojun Hagino #include <netinet/in_pcb.h>
9897d8d152SAndre Oppermann #include <netinet/tcp_var.h>
9982cd038dSYoshinobu Inoue #include <netinet6/nd6.h>
1004b79449eSBjoern A. Zeeb #include <netinet/vinet.h>
10182cd038dSYoshinobu Inoue 
102b2630c29SGeorge V. Neville-Neil #ifdef IPSEC
103b9234fafSSam Leffler #include <netipsec/ipsec.h>
104b9234fafSSam Leffler #include <netipsec/ipsec6.h>
105b9234fafSSam Leffler #include <netipsec/key.h>
1062cb64cb2SGeorge V. Neville-Neil #include <netinet6/ip6_ipsec.h>
107b2630c29SGeorge V. Neville-Neil #endif /* IPSEC */
108b9234fafSSam Leffler 
1091469c434SHajimu UMEMOTO #include <netinet6/ip6protosw.h>
110a1f7e5f8SHajimu UMEMOTO #include <netinet6/scope6_var.h>
1114b79449eSBjoern A. Zeeb #include <netinet6/vinet6.h>
1121469c434SHajimu UMEMOTO 
11333cde130SBruce M Simpson extern int in6_mcast_loop;
11482cd038dSYoshinobu Inoue 
11582cd038dSYoshinobu Inoue struct ip6_exthdrs {
11682cd038dSYoshinobu Inoue 	struct mbuf *ip6e_ip6;
11782cd038dSYoshinobu Inoue 	struct mbuf *ip6e_hbh;
11882cd038dSYoshinobu Inoue 	struct mbuf *ip6e_dest1;
11982cd038dSYoshinobu Inoue 	struct mbuf *ip6e_rthdr;
12082cd038dSYoshinobu Inoue 	struct mbuf *ip6e_dest2;
12182cd038dSYoshinobu Inoue };
12282cd038dSYoshinobu Inoue 
123f95d4633SHajimu UMEMOTO static int ip6_pcbopt __P((int, u_char *, int, struct ip6_pktopts **,
12479ba3952SBjoern A. Zeeb 			   struct ucred *, int));
12582cd038dSYoshinobu Inoue static int ip6_pcbopts __P((struct ip6_pktopts **, struct mbuf *,
1267efe5d92SHajimu UMEMOTO 	struct socket *, struct sockopt *));
1279233d8f3SDavid E. O'Brien static int ip6_getpcbopt(struct ip6_pktopts *, int, struct sockopt *);
12879ba3952SBjoern A. Zeeb static int ip6_setpktopt __P((int, u_char *, int, struct ip6_pktopts *,
12979ba3952SBjoern A. Zeeb 	struct ucred *, int, int, int));
130f95d4633SHajimu UMEMOTO 
1319233d8f3SDavid E. O'Brien static int ip6_copyexthdr(struct mbuf **, caddr_t, int);
13282cd038dSYoshinobu Inoue static int ip6_insertfraghdr __P((struct mbuf *, struct mbuf *, int,
13382cd038dSYoshinobu Inoue 	struct ip6_frag **));
1349233d8f3SDavid E. O'Brien static int ip6_insert_jumboopt(struct ip6_exthdrs *, u_int32_t);
1359233d8f3SDavid E. O'Brien static int ip6_splithdr(struct mbuf *, struct ip6_exthdrs *);
13631b3783cSHajimu UMEMOTO static int ip6_getpmtu __P((struct route_in6 *, struct route_in6 *,
137f95d4633SHajimu UMEMOTO 	struct ifnet *, struct in6_addr *, u_long *, int *));
1389233d8f3SDavid E. O'Brien static int copypktopts(struct ip6_pktopts *, struct ip6_pktopts *, int);
13982cd038dSYoshinobu Inoue 
1407efe5d92SHajimu UMEMOTO 
14182cd038dSYoshinobu Inoue /*
1422cb64cb2SGeorge V. Neville-Neil  * Make an extension header from option data.  hp is the source, and
1432cb64cb2SGeorge V. Neville-Neil  * mp is the destination.
1442cb64cb2SGeorge V. Neville-Neil  */
1452cb64cb2SGeorge V. Neville-Neil #define MAKE_EXTHDR(hp, mp)						\
1462cb64cb2SGeorge V. Neville-Neil     do {								\
1472cb64cb2SGeorge V. Neville-Neil 	if (hp) {							\
1482cb64cb2SGeorge V. Neville-Neil 		struct ip6_ext *eh = (struct ip6_ext *)(hp);		\
1492cb64cb2SGeorge V. Neville-Neil 		error = ip6_copyexthdr((mp), (caddr_t)(hp),		\
1502cb64cb2SGeorge V. Neville-Neil 		    ((eh)->ip6e_len + 1) << 3);				\
1512cb64cb2SGeorge V. Neville-Neil 		if (error)						\
1522cb64cb2SGeorge V. Neville-Neil 			goto freehdrs;					\
1532cb64cb2SGeorge V. Neville-Neil 	}								\
1542cb64cb2SGeorge V. Neville-Neil     } while (/*CONSTCOND*/ 0)
1552cb64cb2SGeorge V. Neville-Neil 
1562cb64cb2SGeorge V. Neville-Neil /*
1572cb64cb2SGeorge V. Neville-Neil  * Form a chain of extension headers.
1582cb64cb2SGeorge V. Neville-Neil  * m is the extension header mbuf
1592cb64cb2SGeorge V. Neville-Neil  * mp is the previous mbuf in the chain
1602cb64cb2SGeorge V. Neville-Neil  * p is the next header
1612cb64cb2SGeorge V. Neville-Neil  * i is the type of option.
1622cb64cb2SGeorge V. Neville-Neil  */
1632cb64cb2SGeorge V. Neville-Neil #define MAKE_CHAIN(m, mp, p, i)\
1642cb64cb2SGeorge V. Neville-Neil     do {\
1652cb64cb2SGeorge V. Neville-Neil 	if (m) {\
1662cb64cb2SGeorge V. Neville-Neil 		if (!hdrsplit) \
1672cb64cb2SGeorge V. Neville-Neil 			panic("assumption failed: hdr not split"); \
1682cb64cb2SGeorge V. Neville-Neil 		*mtod((m), u_char *) = *(p);\
1692cb64cb2SGeorge V. Neville-Neil 		*(p) = (i);\
1702cb64cb2SGeorge V. Neville-Neil 		p = mtod((m), u_char *);\
1712cb64cb2SGeorge V. Neville-Neil 		(m)->m_next = (mp)->m_next;\
1722cb64cb2SGeorge V. Neville-Neil 		(mp)->m_next = (m);\
1732cb64cb2SGeorge V. Neville-Neil 		(mp) = (m);\
1742cb64cb2SGeorge V. Neville-Neil 	}\
1752cb64cb2SGeorge V. Neville-Neil     } while (/*CONSTCOND*/ 0)
1762cb64cb2SGeorge V. Neville-Neil 
1772cb64cb2SGeorge V. Neville-Neil /*
17882cd038dSYoshinobu Inoue  * IP6 output. The packet in mbuf chain m contains a skeletal IP6
17982cd038dSYoshinobu Inoue  * header (with pri, len, nxt, hlim, src, dst).
18082cd038dSYoshinobu Inoue  * This function may modify ver and hlim only.
18182cd038dSYoshinobu Inoue  * The mbuf chain containing the packet will be freed.
18282cd038dSYoshinobu Inoue  * The mbuf opt, if present, will not be freed.
18333841545SHajimu UMEMOTO  *
18433841545SHajimu UMEMOTO  * type of "mtu": rt_rmx.rmx_mtu is u_long, ifnet.ifr_mtu is int, and
18533841545SHajimu UMEMOTO  * nd_ifinfo.linkmtu is u_int32_t.  so we use u_long to hold largest one,
18633841545SHajimu UMEMOTO  * which is rt_rmx.rmx_mtu.
1871272577eSXin LI  *
1881272577eSXin LI  * ifpp - XXX: just for statistics
18982cd038dSYoshinobu Inoue  */
19082cd038dSYoshinobu Inoue int
1911272577eSXin LI ip6_output(struct mbuf *m0, struct ip6_pktopts *opt,
1921272577eSXin LI     struct route_in6 *ro, int flags, struct ip6_moptions *im6o,
1931272577eSXin LI     struct ifnet **ifpp, struct inpcb *inp)
19482cd038dSYoshinobu Inoue {
1958b615593SMarko Zec 	INIT_VNET_NET(curvnet);
1968b615593SMarko Zec 	INIT_VNET_INET6(curvnet);
19782cd038dSYoshinobu Inoue 	struct ip6_hdr *ip6, *mhip6;
198686cdd19SJun-ichiro itojun Hagino 	struct ifnet *ifp, *origifp;
19982cd038dSYoshinobu Inoue 	struct mbuf *m = m0;
2002cb64cb2SGeorge V. Neville-Neil 	struct mbuf *mprev = NULL;
20182cd038dSYoshinobu Inoue 	int hlen, tlen, len, off;
20282cd038dSYoshinobu Inoue 	struct route_in6 ip6route;
203a1f7e5f8SHajimu UMEMOTO 	struct rtentry *rt = NULL;
204a1f7e5f8SHajimu UMEMOTO 	struct sockaddr_in6 *dst, src_sa, dst_sa;
2058195404bSBrooks Davis 	struct in6_addr odst;
20682cd038dSYoshinobu Inoue 	int error = 0;
2075da9f8faSJosef Karthauser 	struct in6_ifaddr *ia = NULL;
20882cd038dSYoshinobu Inoue 	u_long mtu;
209f95d4633SHajimu UMEMOTO 	int alwaysfrag, dontfrag;
21082cd038dSYoshinobu Inoue 	u_int32_t optlen = 0, plen = 0, unfragpartlen = 0;
21182cd038dSYoshinobu Inoue 	struct ip6_exthdrs exthdrs;
212a1f7e5f8SHajimu UMEMOTO 	struct in6_addr finaldst, src0, dst0;
213a1f7e5f8SHajimu UMEMOTO 	u_int32_t zone;
21482cd038dSYoshinobu Inoue 	struct route_in6 *ro_pmtu = NULL;
21582cd038dSYoshinobu Inoue 	int hdrsplit = 0;
21682cd038dSYoshinobu Inoue 	int needipsec = 0;
217b2630c29SGeorge V. Neville-Neil #ifdef IPSEC
2182cb64cb2SGeorge V. Neville-Neil 	struct ipsec_output_state state;
2192cb64cb2SGeorge V. Neville-Neil 	struct ip6_rthdr *rh = NULL;
220b9234fafSSam Leffler 	int needipsectun = 0;
2212cb64cb2SGeorge V. Neville-Neil 	int segleft_org = 0;
222b9234fafSSam Leffler 	struct secpolicy *sp = NULL;
223b2630c29SGeorge V. Neville-Neil #endif /* IPSEC */
224b9234fafSSam Leffler 
225b9234fafSSam Leffler 	ip6 = mtod(m, struct ip6_hdr *);
2262cb64cb2SGeorge V. Neville-Neil 	if (ip6 == NULL) {
2272cb64cb2SGeorge V. Neville-Neil 		printf ("ip6 is NULL");
2282cb64cb2SGeorge V. Neville-Neil 		goto bad;
2292cb64cb2SGeorge V. Neville-Neil 	}
23082cd038dSYoshinobu Inoue 
2312cb64cb2SGeorge V. Neville-Neil 	finaldst = ip6->ip6_dst;
23282cd038dSYoshinobu Inoue 
23382cd038dSYoshinobu Inoue 	bzero(&exthdrs, sizeof(exthdrs));
234686cdd19SJun-ichiro itojun Hagino 
23582cd038dSYoshinobu Inoue 	if (opt) {
23682cd038dSYoshinobu Inoue 		/* Hop-by-Hop options header */
23782cd038dSYoshinobu Inoue 		MAKE_EXTHDR(opt->ip6po_hbh, &exthdrs.ip6e_hbh);
23882cd038dSYoshinobu Inoue 		/* Destination options header(1st part) */
23929bc2c48SHajimu UMEMOTO 		if (opt->ip6po_rthdr) {
24029bc2c48SHajimu UMEMOTO 			/*
24129bc2c48SHajimu UMEMOTO 			 * Destination options header(1st part)
2422cb64cb2SGeorge V. Neville-Neil 			 * This only makes sense with a routing header.
24329bc2c48SHajimu UMEMOTO 			 * See Section 9.2 of RFC 3542.
24429bc2c48SHajimu UMEMOTO 			 * Disabling this part just for MIP6 convenience is
24529bc2c48SHajimu UMEMOTO 			 * a bad idea.  We need to think carefully about a
24629bc2c48SHajimu UMEMOTO 			 * way to make the advanced API coexist with MIP6
24729bc2c48SHajimu UMEMOTO 			 * options, which might automatically be inserted in
24829bc2c48SHajimu UMEMOTO 			 * the kernel.
24929bc2c48SHajimu UMEMOTO 			 */
25082cd038dSYoshinobu Inoue 			MAKE_EXTHDR(opt->ip6po_dest1, &exthdrs.ip6e_dest1);
25129bc2c48SHajimu UMEMOTO 		}
25282cd038dSYoshinobu Inoue 		/* Routing header */
25382cd038dSYoshinobu Inoue 		MAKE_EXTHDR(opt->ip6po_rthdr, &exthdrs.ip6e_rthdr);
25482cd038dSYoshinobu Inoue 		/* Destination options header(2nd part) */
25582cd038dSYoshinobu Inoue 		MAKE_EXTHDR(opt->ip6po_dest2, &exthdrs.ip6e_dest2);
25682cd038dSYoshinobu Inoue 	}
25782cd038dSYoshinobu Inoue 
25882cd038dSYoshinobu Inoue 	/*
2592cb64cb2SGeorge V. Neville-Neil 	 * IPSec checking which handles several cases.
2602cb64cb2SGeorge V. Neville-Neil 	 * FAST IPSEC: We re-injected the packet.
26182cd038dSYoshinobu Inoue 	 */
262b2630c29SGeorge V. Neville-Neil #ifdef IPSEC
2632cb64cb2SGeorge V. Neville-Neil 	switch(ip6_ipsec_output(&m, inp, &flags, &error, &ifp, &sp))
2642cb64cb2SGeorge V. Neville-Neil 	{
2652cb64cb2SGeorge V. Neville-Neil 	case 1:                 /* Bad packet */
266b9234fafSSam Leffler 		goto freehdrs;
2672cb64cb2SGeorge V. Neville-Neil 	case -1:                /* Do IPSec */
268b9234fafSSam Leffler 		needipsec = 1;
2692cb64cb2SGeorge V. Neville-Neil 	case 0:                 /* No IPSec */
270b9234fafSSam Leffler 	default:
2712cb64cb2SGeorge V. Neville-Neil 		break;
272b9234fafSSam Leffler 	}
273b2630c29SGeorge V. Neville-Neil #endif /* IPSEC */
27482cd038dSYoshinobu Inoue 
27582cd038dSYoshinobu Inoue 	/*
27682cd038dSYoshinobu Inoue 	 * Calculate the total length of the extension header chain.
27782cd038dSYoshinobu Inoue 	 * Keep the length of the unfragmentable part for fragmentation.
27882cd038dSYoshinobu Inoue 	 */
27982cd038dSYoshinobu Inoue 	optlen = 0;
2802cb64cb2SGeorge V. Neville-Neil 	if (exthdrs.ip6e_hbh)
2812cb64cb2SGeorge V. Neville-Neil 		optlen += exthdrs.ip6e_hbh->m_len;
2822cb64cb2SGeorge V. Neville-Neil 	if (exthdrs.ip6e_dest1)
2832cb64cb2SGeorge V. Neville-Neil 		optlen += exthdrs.ip6e_dest1->m_len;
2842cb64cb2SGeorge V. Neville-Neil 	if (exthdrs.ip6e_rthdr)
2852cb64cb2SGeorge V. Neville-Neil 		optlen += exthdrs.ip6e_rthdr->m_len;
28682cd038dSYoshinobu Inoue 	unfragpartlen = optlen + sizeof(struct ip6_hdr);
2872cb64cb2SGeorge V. Neville-Neil 
28882cd038dSYoshinobu Inoue 	/* NOTE: we don't add AH/ESP length here. do that later. */
2892cb64cb2SGeorge V. Neville-Neil 	if (exthdrs.ip6e_dest2)
2902cb64cb2SGeorge V. Neville-Neil 		optlen += exthdrs.ip6e_dest2->m_len;
29182cd038dSYoshinobu Inoue 
29282cd038dSYoshinobu Inoue 	/*
29382cd038dSYoshinobu Inoue 	 * If we need IPsec, or there is at least one extension header,
29482cd038dSYoshinobu Inoue 	 * separate IP6 header from the payload.
29582cd038dSYoshinobu Inoue 	 */
29682cd038dSYoshinobu Inoue 	if ((needipsec || optlen) && !hdrsplit) {
29782cd038dSYoshinobu Inoue 		if ((error = ip6_splithdr(m, &exthdrs)) != 0) {
29882cd038dSYoshinobu Inoue 			m = NULL;
29982cd038dSYoshinobu Inoue 			goto freehdrs;
30082cd038dSYoshinobu Inoue 		}
30182cd038dSYoshinobu Inoue 		m = exthdrs.ip6e_ip6;
30282cd038dSYoshinobu Inoue 		hdrsplit++;
30382cd038dSYoshinobu Inoue 	}
30482cd038dSYoshinobu Inoue 
30582cd038dSYoshinobu Inoue 	/* adjust pointer */
30682cd038dSYoshinobu Inoue 	ip6 = mtod(m, struct ip6_hdr *);
30782cd038dSYoshinobu Inoue 
30882cd038dSYoshinobu Inoue 	/* adjust mbuf packet header length */
30982cd038dSYoshinobu Inoue 	m->m_pkthdr.len += optlen;
31082cd038dSYoshinobu Inoue 	plen = m->m_pkthdr.len - sizeof(*ip6);
31182cd038dSYoshinobu Inoue 
31282cd038dSYoshinobu Inoue 	/* If this is a jumbo payload, insert a jumbo payload option. */
31382cd038dSYoshinobu Inoue 	if (plen > IPV6_MAXPACKET) {
31482cd038dSYoshinobu Inoue 		if (!hdrsplit) {
31582cd038dSYoshinobu Inoue 			if ((error = ip6_splithdr(m, &exthdrs)) != 0) {
31682cd038dSYoshinobu Inoue 				m = NULL;
31782cd038dSYoshinobu Inoue 				goto freehdrs;
31882cd038dSYoshinobu Inoue 			}
31982cd038dSYoshinobu Inoue 			m = exthdrs.ip6e_ip6;
32082cd038dSYoshinobu Inoue 			hdrsplit++;
32182cd038dSYoshinobu Inoue 		}
32282cd038dSYoshinobu Inoue 		/* adjust pointer */
32382cd038dSYoshinobu Inoue 		ip6 = mtod(m, struct ip6_hdr *);
32482cd038dSYoshinobu Inoue 		if ((error = ip6_insert_jumboopt(&exthdrs, plen)) != 0)
32582cd038dSYoshinobu Inoue 			goto freehdrs;
32682cd038dSYoshinobu Inoue 		ip6->ip6_plen = 0;
32782cd038dSYoshinobu Inoue 	} else
32882cd038dSYoshinobu Inoue 		ip6->ip6_plen = htons(plen);
32982cd038dSYoshinobu Inoue 
33082cd038dSYoshinobu Inoue 	/*
33182cd038dSYoshinobu Inoue 	 * Concatenate headers and fill in next header fields.
33282cd038dSYoshinobu Inoue 	 * Here we have, on "m"
33382cd038dSYoshinobu Inoue 	 *	IPv6 payload
33482cd038dSYoshinobu Inoue 	 * and we insert headers accordingly.  Finally, we should be getting:
33582cd038dSYoshinobu Inoue 	 *	IPv6 hbh dest1 rthdr ah* [esp* dest2 payload]
33682cd038dSYoshinobu Inoue 	 *
33782cd038dSYoshinobu Inoue 	 * during the header composing process, "m" points to IPv6 header.
33882cd038dSYoshinobu Inoue 	 * "mprev" points to an extension header prior to esp.
33982cd038dSYoshinobu Inoue 	 */
34082cd038dSYoshinobu Inoue 	u_char *nexthdrp = &ip6->ip6_nxt;
3412cb64cb2SGeorge V. Neville-Neil 	mprev = m;
34282cd038dSYoshinobu Inoue 
34382cd038dSYoshinobu Inoue 	/*
34482cd038dSYoshinobu Inoue 	 * we treat dest2 specially.  this makes IPsec processing
34588ff5695SSUZUKI Shinsuke 	 * much easier.  the goal here is to make mprev point the
34688ff5695SSUZUKI Shinsuke 	 * mbuf prior to dest2.
34782cd038dSYoshinobu Inoue 	 *
34882cd038dSYoshinobu Inoue 	 * result: IPv6 dest2 payload
34982cd038dSYoshinobu Inoue 	 * m and mprev will point to IPv6 header.
35082cd038dSYoshinobu Inoue 	 */
35182cd038dSYoshinobu Inoue 	if (exthdrs.ip6e_dest2) {
35282cd038dSYoshinobu Inoue 		if (!hdrsplit)
35382cd038dSYoshinobu Inoue 			panic("assumption failed: hdr not split");
35482cd038dSYoshinobu Inoue 		exthdrs.ip6e_dest2->m_next = m->m_next;
35582cd038dSYoshinobu Inoue 		m->m_next = exthdrs.ip6e_dest2;
35682cd038dSYoshinobu Inoue 		*mtod(exthdrs.ip6e_dest2, u_char *) = ip6->ip6_nxt;
35782cd038dSYoshinobu Inoue 		ip6->ip6_nxt = IPPROTO_DSTOPTS;
35882cd038dSYoshinobu Inoue 	}
35982cd038dSYoshinobu Inoue 
36082cd038dSYoshinobu Inoue 	/*
36182cd038dSYoshinobu Inoue 	 * result: IPv6 hbh dest1 rthdr dest2 payload
36282cd038dSYoshinobu Inoue 	 * m will point to IPv6 header.  mprev will point to the
36382cd038dSYoshinobu Inoue 	 * extension header prior to dest2 (rthdr in the above case).
36482cd038dSYoshinobu Inoue 	 */
3657efe5d92SHajimu UMEMOTO 	MAKE_CHAIN(exthdrs.ip6e_hbh, mprev, nexthdrp, IPPROTO_HOPOPTS);
3667efe5d92SHajimu UMEMOTO 	MAKE_CHAIN(exthdrs.ip6e_dest1, mprev, nexthdrp,
3677efe5d92SHajimu UMEMOTO 		   IPPROTO_DSTOPTS);
3687efe5d92SHajimu UMEMOTO 	MAKE_CHAIN(exthdrs.ip6e_rthdr, mprev, nexthdrp,
3697efe5d92SHajimu UMEMOTO 		   IPPROTO_ROUTING);
37082cd038dSYoshinobu Inoue 
371b2630c29SGeorge V. Neville-Neil #ifdef IPSEC
37282cd038dSYoshinobu Inoue 	if (!needipsec)
37382cd038dSYoshinobu Inoue 		goto skip_ipsec2;
37482cd038dSYoshinobu Inoue 
37582cd038dSYoshinobu Inoue 	/*
37682cd038dSYoshinobu Inoue 	 * pointers after IPsec headers are not valid any more.
37782cd038dSYoshinobu Inoue 	 * other pointers need a great care too.
37882cd038dSYoshinobu Inoue 	 * (IPsec routines should not mangle mbufs prior to AH/ESP)
37982cd038dSYoshinobu Inoue 	 */
38082cd038dSYoshinobu Inoue 	exthdrs.ip6e_dest2 = NULL;
38182cd038dSYoshinobu Inoue 
38282cd038dSYoshinobu Inoue 	if (exthdrs.ip6e_rthdr) {
38382cd038dSYoshinobu Inoue 		rh = mtod(exthdrs.ip6e_rthdr, struct ip6_rthdr *);
38482cd038dSYoshinobu Inoue 		segleft_org = rh->ip6r_segleft;
38582cd038dSYoshinobu Inoue 		rh->ip6r_segleft = 0;
38682cd038dSYoshinobu Inoue 	}
38782cd038dSYoshinobu Inoue 
38882cd038dSYoshinobu Inoue 	bzero(&state, sizeof(state));
38982cd038dSYoshinobu Inoue 	state.m = m;
39082cd038dSYoshinobu Inoue 	error = ipsec6_output_trans(&state, nexthdrp, mprev, sp, flags,
39182cd038dSYoshinobu Inoue 				    &needipsectun);
39282cd038dSYoshinobu Inoue 	m = state.m;
3939e3bdedeSBjoern A. Zeeb 	if (error == EJUSTRETURN) {
3949e3bdedeSBjoern A. Zeeb 		/*
3959e3bdedeSBjoern A. Zeeb 		 * We had a SP with a level of 'use' and no SA. We
3969e3bdedeSBjoern A. Zeeb 		 * will just continue to process the packet without
3979e3bdedeSBjoern A. Zeeb 		 * IPsec processing.
3989e3bdedeSBjoern A. Zeeb 		 */
3999e3bdedeSBjoern A. Zeeb 		;
4009e3bdedeSBjoern A. Zeeb 	} else if (error) {
40182cd038dSYoshinobu Inoue 		/* mbuf is already reclaimed in ipsec6_output_trans. */
40282cd038dSYoshinobu Inoue 		m = NULL;
40382cd038dSYoshinobu Inoue 		switch (error) {
40482cd038dSYoshinobu Inoue 		case EHOSTUNREACH:
40582cd038dSYoshinobu Inoue 		case ENETUNREACH:
40682cd038dSYoshinobu Inoue 		case EMSGSIZE:
40782cd038dSYoshinobu Inoue 		case ENOBUFS:
40882cd038dSYoshinobu Inoue 		case ENOMEM:
40982cd038dSYoshinobu Inoue 			break;
41082cd038dSYoshinobu Inoue 		default:
41141aa71ddSBjoern A. Zeeb 			printf("[%s:%d] (ipsec): error code %d\n",
41241aa71ddSBjoern A. Zeeb 			    __func__, __LINE__, error);
4137efe5d92SHajimu UMEMOTO 			/* FALLTHROUGH */
41482cd038dSYoshinobu Inoue 		case ENOENT:
41582cd038dSYoshinobu Inoue 			/* don't show these error codes to the user */
41682cd038dSYoshinobu Inoue 			error = 0;
41782cd038dSYoshinobu Inoue 			break;
41882cd038dSYoshinobu Inoue 		}
41982cd038dSYoshinobu Inoue 		goto bad;
4202cb64cb2SGeorge V. Neville-Neil 	} else if (!needipsectun) {
4212cb64cb2SGeorge V. Neville-Neil 		/*
4222cb64cb2SGeorge V. Neville-Neil 		 * In the FAST IPSec case we have already
4232cb64cb2SGeorge V. Neville-Neil 		 * re-injected the packet and it has been freed
4242cb64cb2SGeorge V. Neville-Neil 		 * by the ipsec_done() function.  So, just clean
4252cb64cb2SGeorge V. Neville-Neil 		 * up after ourselves.
4262cb64cb2SGeorge V. Neville-Neil 		 */
4272cb64cb2SGeorge V. Neville-Neil 		m = NULL;
4282cb64cb2SGeorge V. Neville-Neil 		goto done;
42982cd038dSYoshinobu Inoue 	}
43082cd038dSYoshinobu Inoue 	if (exthdrs.ip6e_rthdr) {
43182cd038dSYoshinobu Inoue 		/* ah6_output doesn't modify mbuf chain */
43282cd038dSYoshinobu Inoue 		rh->ip6r_segleft = segleft_org;
43382cd038dSYoshinobu Inoue 	}
43482cd038dSYoshinobu Inoue skip_ipsec2:;
435b2630c29SGeorge V. Neville-Neil #endif /* IPSEC */
43682cd038dSYoshinobu Inoue 
43782cd038dSYoshinobu Inoue 	/*
43871ce264cSWarner Losh 	 * If there is a routing header, discard the packet.
43982cd038dSYoshinobu Inoue 	 */
44082cd038dSYoshinobu Inoue 	if (exthdrs.ip6e_rthdr) {
44182cd038dSYoshinobu Inoue 		 error = EINVAL;
44282cd038dSYoshinobu Inoue 		 goto bad;
44382cd038dSYoshinobu Inoue 	}
44482cd038dSYoshinobu Inoue 
44582cd038dSYoshinobu Inoue 	/* Source address validation */
44682cd038dSYoshinobu Inoue 	if (IN6_IS_ADDR_UNSPECIFIED(&ip6->ip6_src) &&
4474ecbe331SSUZUKI Shinsuke 	    (flags & IPV6_UNSPECSRC) == 0) {
44882cd038dSYoshinobu Inoue 		error = EOPNOTSUPP;
449603724d3SBjoern A. Zeeb 		V_ip6stat.ip6s_badscope++;
45082cd038dSYoshinobu Inoue 		goto bad;
45182cd038dSYoshinobu Inoue 	}
45282cd038dSYoshinobu Inoue 	if (IN6_IS_ADDR_MULTICAST(&ip6->ip6_src)) {
45382cd038dSYoshinobu Inoue 		error = EOPNOTSUPP;
454603724d3SBjoern A. Zeeb 		V_ip6stat.ip6s_badscope++;
45582cd038dSYoshinobu Inoue 		goto bad;
45682cd038dSYoshinobu Inoue 	}
45782cd038dSYoshinobu Inoue 
458603724d3SBjoern A. Zeeb 	V_ip6stat.ip6s_localout++;
45982cd038dSYoshinobu Inoue 
46082cd038dSYoshinobu Inoue 	/*
46182cd038dSYoshinobu Inoue 	 * Route packet.
46282cd038dSYoshinobu Inoue 	 */
46382cd038dSYoshinobu Inoue 	if (ro == 0) {
46482cd038dSYoshinobu Inoue 		ro = &ip6route;
46582cd038dSYoshinobu Inoue 		bzero((caddr_t)ro, sizeof(*ro));
46682cd038dSYoshinobu Inoue 	}
46782cd038dSYoshinobu Inoue 	ro_pmtu = ro;
46882cd038dSYoshinobu Inoue 	if (opt && opt->ip6po_rthdr)
46982cd038dSYoshinobu Inoue 		ro = &opt->ip6po_route;
47082cd038dSYoshinobu Inoue 	dst = (struct sockaddr_in6 *)&ro->ro_dst;
4717efe5d92SHajimu UMEMOTO 
4728195404bSBrooks Davis again:
47382cd038dSYoshinobu Inoue 	/*
474f95d4633SHajimu UMEMOTO 	 * if specified, try to fill in the traffic class field.
475f95d4633SHajimu UMEMOTO 	 * do not override if a non-zero value is already set.
476f95d4633SHajimu UMEMOTO 	 * we check the diffserv field and the ecn field separately.
477f95d4633SHajimu UMEMOTO 	 */
478f95d4633SHajimu UMEMOTO 	if (opt && opt->ip6po_tclass >= 0) {
479f95d4633SHajimu UMEMOTO 		int mask = 0;
480f95d4633SHajimu UMEMOTO 
481f95d4633SHajimu UMEMOTO 		if ((ip6->ip6_flow & htonl(0xfc << 20)) == 0)
482f95d4633SHajimu UMEMOTO 			mask |= 0xfc;
483f95d4633SHajimu UMEMOTO 		if ((ip6->ip6_flow & htonl(0x03 << 20)) == 0)
484f95d4633SHajimu UMEMOTO 			mask |= 0x03;
485f95d4633SHajimu UMEMOTO 		if (mask != 0)
486f95d4633SHajimu UMEMOTO 			ip6->ip6_flow |= htonl((opt->ip6po_tclass & mask) << 20);
487f95d4633SHajimu UMEMOTO 	}
488f95d4633SHajimu UMEMOTO 
489f95d4633SHajimu UMEMOTO 	/* fill in or override the hop limit field, if necessary. */
490f95d4633SHajimu UMEMOTO 	if (opt && opt->ip6po_hlim != -1)
491f95d4633SHajimu UMEMOTO 		ip6->ip6_hlim = opt->ip6po_hlim & 0xff;
492f95d4633SHajimu UMEMOTO 	else if (IN6_IS_ADDR_MULTICAST(&ip6->ip6_dst)) {
493f95d4633SHajimu UMEMOTO 		if (im6o != NULL)
494f95d4633SHajimu UMEMOTO 			ip6->ip6_hlim = im6o->im6o_multicast_hlim;
495f95d4633SHajimu UMEMOTO 		else
496603724d3SBjoern A. Zeeb 			ip6->ip6_hlim = V_ip6_defmcasthlim;
497f95d4633SHajimu UMEMOTO 	}
498f95d4633SHajimu UMEMOTO 
499b2630c29SGeorge V. Neville-Neil #ifdef IPSEC
5002cb64cb2SGeorge V. Neville-Neil 	/*
501b2630c29SGeorge V. Neville-Neil 	 * We may re-inject packets into the stack here.
5022cb64cb2SGeorge V. Neville-Neil 	 */
50382cd038dSYoshinobu Inoue 	if (needipsec && needipsectun) {
50482cd038dSYoshinobu Inoue 		struct ipsec_output_state state;
50582cd038dSYoshinobu Inoue 
50682cd038dSYoshinobu Inoue 		/*
50782cd038dSYoshinobu Inoue 		 * All the extension headers will become inaccessible
50882cd038dSYoshinobu Inoue 		 * (since they can be encrypted).
50982cd038dSYoshinobu Inoue 		 * Don't panic, we need no more updates to extension headers
51082cd038dSYoshinobu Inoue 		 * on inner IPv6 packet (since they are now encapsulated).
51182cd038dSYoshinobu Inoue 		 *
51282cd038dSYoshinobu Inoue 		 * IPv6 [ESP|AH] IPv6 [extension headers] payload
51382cd038dSYoshinobu Inoue 		 */
51482cd038dSYoshinobu Inoue 		bzero(&exthdrs, sizeof(exthdrs));
51582cd038dSYoshinobu Inoue 		exthdrs.ip6e_ip6 = m;
51682cd038dSYoshinobu Inoue 
51782cd038dSYoshinobu Inoue 		bzero(&state, sizeof(state));
51882cd038dSYoshinobu Inoue 		state.m = m;
51982cd038dSYoshinobu Inoue 		state.ro = (struct route *)ro;
52082cd038dSYoshinobu Inoue 		state.dst = (struct sockaddr *)dst;
52182cd038dSYoshinobu Inoue 
52282cd038dSYoshinobu Inoue 		error = ipsec6_output_tunnel(&state, sp, flags);
52382cd038dSYoshinobu Inoue 
52482cd038dSYoshinobu Inoue 		m = state.m;
52582cd038dSYoshinobu Inoue 		ro = (struct route_in6 *)state.ro;
52682cd038dSYoshinobu Inoue 		dst = (struct sockaddr_in6 *)state.dst;
5279e3bdedeSBjoern A. Zeeb 		if (error == EJUSTRETURN) {
5289e3bdedeSBjoern A. Zeeb 			/*
5299e3bdedeSBjoern A. Zeeb 			 * We had a SP with a level of 'use' and no SA. We
5309e3bdedeSBjoern A. Zeeb 			 * will just continue to process the packet without
5319e3bdedeSBjoern A. Zeeb 			 * IPsec processing.
5329e3bdedeSBjoern A. Zeeb 			 */
5339e3bdedeSBjoern A. Zeeb 			;
5349e3bdedeSBjoern A. Zeeb 		} else if (error) {
53582cd038dSYoshinobu Inoue 			/* mbuf is already reclaimed in ipsec6_output_tunnel. */
53682cd038dSYoshinobu Inoue 			m0 = m = NULL;
53782cd038dSYoshinobu Inoue 			m = NULL;
53882cd038dSYoshinobu Inoue 			switch (error) {
53982cd038dSYoshinobu Inoue 			case EHOSTUNREACH:
54082cd038dSYoshinobu Inoue 			case ENETUNREACH:
54182cd038dSYoshinobu Inoue 			case EMSGSIZE:
54282cd038dSYoshinobu Inoue 			case ENOBUFS:
54382cd038dSYoshinobu Inoue 			case ENOMEM:
54482cd038dSYoshinobu Inoue 				break;
54582cd038dSYoshinobu Inoue 			default:
54641aa71ddSBjoern A. Zeeb 				printf("[%s:%d] (ipsec): error code %d\n",
54741aa71ddSBjoern A. Zeeb 				    __func__, __LINE__, error);
5487efe5d92SHajimu UMEMOTO 				/* FALLTHROUGH */
54982cd038dSYoshinobu Inoue 			case ENOENT:
55082cd038dSYoshinobu Inoue 				/* don't show these error codes to the user */
55182cd038dSYoshinobu Inoue 				error = 0;
55282cd038dSYoshinobu Inoue 				break;
55382cd038dSYoshinobu Inoue 			}
55482cd038dSYoshinobu Inoue 			goto bad;
5552cb64cb2SGeorge V. Neville-Neil 		} else {
5562cb64cb2SGeorge V. Neville-Neil 			/*
5572cb64cb2SGeorge V. Neville-Neil 			 * In the FAST IPSec case we have already
5582cb64cb2SGeorge V. Neville-Neil 			 * re-injected the packet and it has been freed
5592cb64cb2SGeorge V. Neville-Neil 			 * by the ipsec_done() function.  So, just clean
5602cb64cb2SGeorge V. Neville-Neil 			 * up after ourselves.
5612cb64cb2SGeorge V. Neville-Neil 			 */
5622cb64cb2SGeorge V. Neville-Neil 			m = NULL;
5632cb64cb2SGeorge V. Neville-Neil 			goto done;
56482cd038dSYoshinobu Inoue 		}
56582cd038dSYoshinobu Inoue 
56682cd038dSYoshinobu Inoue 		exthdrs.ip6e_ip6 = m;
56782cd038dSYoshinobu Inoue 	}
568b2630c29SGeorge V. Neville-Neil #endif /* IPSEC */
56982cd038dSYoshinobu Inoue 
570a1f7e5f8SHajimu UMEMOTO 	/* adjust pointer */
571a1f7e5f8SHajimu UMEMOTO 	ip6 = mtod(m, struct ip6_hdr *);
57282cd038dSYoshinobu Inoue 
573a1f7e5f8SHajimu UMEMOTO 	bzero(&dst_sa, sizeof(dst_sa));
574a1f7e5f8SHajimu UMEMOTO 	dst_sa.sin6_family = AF_INET6;
575a1f7e5f8SHajimu UMEMOTO 	dst_sa.sin6_len = sizeof(dst_sa);
576a1f7e5f8SHajimu UMEMOTO 	dst_sa.sin6_addr = ip6->ip6_dst;
577a1f7e5f8SHajimu UMEMOTO 	if ((error = in6_selectroute(&dst_sa, opt, im6o, ro,
5786e6b3f7cSQing Li 	    &ifp, &rt)) != 0) {
579a1f7e5f8SHajimu UMEMOTO 		switch (error) {
580a1f7e5f8SHajimu UMEMOTO 		case EHOSTUNREACH:
581603724d3SBjoern A. Zeeb 			V_ip6stat.ip6s_noroute++;
582a1f7e5f8SHajimu UMEMOTO 			break;
583a1f7e5f8SHajimu UMEMOTO 		case EADDRNOTAVAIL:
584a1f7e5f8SHajimu UMEMOTO 		default:
585a1f7e5f8SHajimu UMEMOTO 			break; /* XXX statistics? */
58682cd038dSYoshinobu Inoue 		}
587a1f7e5f8SHajimu UMEMOTO 		if (ifp != NULL)
58882cd038dSYoshinobu Inoue 			in6_ifstat_inc(ifp, ifs6_out_discard);
58982cd038dSYoshinobu Inoue 		goto bad;
59082cd038dSYoshinobu Inoue 	}
591a1f7e5f8SHajimu UMEMOTO 	if (rt == NULL) {
592a1f7e5f8SHajimu UMEMOTO 		/*
593a1f7e5f8SHajimu UMEMOTO 		 * If in6_selectroute() does not return a route entry,
594a1f7e5f8SHajimu UMEMOTO 		 * dst may not have been updated.
595a1f7e5f8SHajimu UMEMOTO 		 */
596a1f7e5f8SHajimu UMEMOTO 		*dst = dst_sa;	/* XXX */
59782cd038dSYoshinobu Inoue 	}
59882cd038dSYoshinobu Inoue 
599a1f7e5f8SHajimu UMEMOTO 	/*
600a1f7e5f8SHajimu UMEMOTO 	 * then rt (for unicast) and ifp must be non-NULL valid values.
601a1f7e5f8SHajimu UMEMOTO 	 */
602a1f7e5f8SHajimu UMEMOTO 	if ((flags & IPV6_FORWARDING) == 0) {
603a1f7e5f8SHajimu UMEMOTO 		/* XXX: the FORWARDING flag can be set for mrouting. */
604a1f7e5f8SHajimu UMEMOTO 		in6_ifstat_inc(ifp, ifs6_out_request);
605a1f7e5f8SHajimu UMEMOTO 	}
606a1f7e5f8SHajimu UMEMOTO 	if (rt != NULL) {
607a1f7e5f8SHajimu UMEMOTO 		ia = (struct in6_ifaddr *)(rt->rt_ifa);
608a1f7e5f8SHajimu UMEMOTO 		rt->rt_use++;
609a1f7e5f8SHajimu UMEMOTO 	}
610a1f7e5f8SHajimu UMEMOTO 
611a1f7e5f8SHajimu UMEMOTO 	/*
612a1f7e5f8SHajimu UMEMOTO 	 * The outgoing interface must be in the zone of source and
613a1f7e5f8SHajimu UMEMOTO 	 * destination addresses.  We should use ia_ifp to support the
614a1f7e5f8SHajimu UMEMOTO 	 * case of sending packets to an address of our own.
615a1f7e5f8SHajimu UMEMOTO 	 */
616a1f7e5f8SHajimu UMEMOTO 	if (ia != NULL && ia->ia_ifp)
617a1f7e5f8SHajimu UMEMOTO 		origifp = ia->ia_ifp;
618a1f7e5f8SHajimu UMEMOTO 	else
619a1f7e5f8SHajimu UMEMOTO 		origifp = ifp;
620a1f7e5f8SHajimu UMEMOTO 
621a1f7e5f8SHajimu UMEMOTO 	src0 = ip6->ip6_src;
622a1f7e5f8SHajimu UMEMOTO 	if (in6_setscope(&src0, origifp, &zone))
623a1f7e5f8SHajimu UMEMOTO 		goto badscope;
624a1f7e5f8SHajimu UMEMOTO 	bzero(&src_sa, sizeof(src_sa));
625a1f7e5f8SHajimu UMEMOTO 	src_sa.sin6_family = AF_INET6;
626a1f7e5f8SHajimu UMEMOTO 	src_sa.sin6_len = sizeof(src_sa);
627a1f7e5f8SHajimu UMEMOTO 	src_sa.sin6_addr = ip6->ip6_src;
628a1f7e5f8SHajimu UMEMOTO 	if (sa6_recoverscope(&src_sa) || zone != src_sa.sin6_scope_id)
629a1f7e5f8SHajimu UMEMOTO 		goto badscope;
630a1f7e5f8SHajimu UMEMOTO 
631a1f7e5f8SHajimu UMEMOTO 	dst0 = ip6->ip6_dst;
632a1f7e5f8SHajimu UMEMOTO 	if (in6_setscope(&dst0, origifp, &zone))
633a1f7e5f8SHajimu UMEMOTO 		goto badscope;
634a1f7e5f8SHajimu UMEMOTO 	/* re-initialize to be sure */
635a1f7e5f8SHajimu UMEMOTO 	bzero(&dst_sa, sizeof(dst_sa));
636a1f7e5f8SHajimu UMEMOTO 	dst_sa.sin6_family = AF_INET6;
637a1f7e5f8SHajimu UMEMOTO 	dst_sa.sin6_len = sizeof(dst_sa);
638a1f7e5f8SHajimu UMEMOTO 	dst_sa.sin6_addr = ip6->ip6_dst;
639a1f7e5f8SHajimu UMEMOTO 	if (sa6_recoverscope(&dst_sa) || zone != dst_sa.sin6_scope_id) {
640a1f7e5f8SHajimu UMEMOTO 		goto badscope;
641a1f7e5f8SHajimu UMEMOTO 	}
642a1f7e5f8SHajimu UMEMOTO 
643a1f7e5f8SHajimu UMEMOTO 	/* scope check is done. */
644a1f7e5f8SHajimu UMEMOTO 	goto routefound;
645a1f7e5f8SHajimu UMEMOTO 
646a1f7e5f8SHajimu UMEMOTO   badscope:
647603724d3SBjoern A. Zeeb 	V_ip6stat.ip6s_badscope++;
648a1f7e5f8SHajimu UMEMOTO 	in6_ifstat_inc(origifp, ifs6_out_discard);
649a1f7e5f8SHajimu UMEMOTO 	if (error == 0)
650a1f7e5f8SHajimu UMEMOTO 		error = EHOSTUNREACH; /* XXX */
651a1f7e5f8SHajimu UMEMOTO 	goto bad;
652a1f7e5f8SHajimu UMEMOTO 
653a1f7e5f8SHajimu UMEMOTO   routefound:
654a1f7e5f8SHajimu UMEMOTO 	if (rt && !IN6_IS_ADDR_MULTICAST(&ip6->ip6_dst)) {
655a1f7e5f8SHajimu UMEMOTO 		if (opt && opt->ip6po_nextroute.ro_rt) {
656a1f7e5f8SHajimu UMEMOTO 			/*
657a1f7e5f8SHajimu UMEMOTO 			 * The nexthop is explicitly specified by the
658a1f7e5f8SHajimu UMEMOTO 			 * application.  We assume the next hop is an IPv6
659a1f7e5f8SHajimu UMEMOTO 			 * address.
660a1f7e5f8SHajimu UMEMOTO 			 */
661a1f7e5f8SHajimu UMEMOTO 			dst = (struct sockaddr_in6 *)opt->ip6po_nexthop;
662a1f7e5f8SHajimu UMEMOTO 		}
663a1f7e5f8SHajimu UMEMOTO 		else if ((rt->rt_flags & RTF_GATEWAY))
664a1f7e5f8SHajimu UMEMOTO 			dst = (struct sockaddr_in6 *)rt->rt_gateway;
665a1f7e5f8SHajimu UMEMOTO 	}
666a1f7e5f8SHajimu UMEMOTO 
667a1f7e5f8SHajimu UMEMOTO 	if (!IN6_IS_ADDR_MULTICAST(&ip6->ip6_dst)) {
668a1f7e5f8SHajimu UMEMOTO 		m->m_flags &= ~(M_BCAST | M_MCAST); /* just in case */
66982cd038dSYoshinobu Inoue 	} else {
67082cd038dSYoshinobu Inoue 		m->m_flags = (m->m_flags & ~M_BCAST) | M_MCAST;
67182cd038dSYoshinobu Inoue 		in6_ifstat_inc(ifp, ifs6_out_mcast);
67282cd038dSYoshinobu Inoue 		/*
67382cd038dSYoshinobu Inoue 		 * Confirm that the outgoing interface supports multicast.
67482cd038dSYoshinobu Inoue 		 */
675a1f7e5f8SHajimu UMEMOTO 		if (!(ifp->if_flags & IFF_MULTICAST)) {
676603724d3SBjoern A. Zeeb 			V_ip6stat.ip6s_noroute++;
67782cd038dSYoshinobu Inoue 			in6_ifstat_inc(ifp, ifs6_out_discard);
67882cd038dSYoshinobu Inoue 			error = ENETUNREACH;
67982cd038dSYoshinobu Inoue 			goto bad;
68082cd038dSYoshinobu Inoue 		}
68133cde130SBruce M Simpson 		if ((im6o == NULL && in6_mcast_loop) ||
68233cde130SBruce M Simpson 		    (im6o && im6o->im6o_multicast_loop)) {
68382cd038dSYoshinobu Inoue 			/*
68433cde130SBruce M Simpson 			 * Loop back multicast datagram if not expressly
68533cde130SBruce M Simpson 			 * forbidden to do so, even if we have not joined
68633cde130SBruce M Simpson 			 * the address; protocols will filter it later,
68733cde130SBruce M Simpson 			 * thus deferring a hash lookup and lock acquisition
68833cde130SBruce M Simpson 			 * at the expense of an m_copym().
68982cd038dSYoshinobu Inoue 			 */
69082cd038dSYoshinobu Inoue 			ip6_mloopback(ifp, m, dst);
69191ec0a1eSYoshinobu Inoue 		} else {
69291ec0a1eSYoshinobu Inoue 			/*
69391ec0a1eSYoshinobu Inoue 			 * If we are acting as a multicast router, perform
69491ec0a1eSYoshinobu Inoue 			 * multicast forwarding as if the packet had just
69591ec0a1eSYoshinobu Inoue 			 * arrived on the interface to which we are about
69691ec0a1eSYoshinobu Inoue 			 * to send.  The multicast forwarding function
69791ec0a1eSYoshinobu Inoue 			 * recursively calls this function, using the
69891ec0a1eSYoshinobu Inoue 			 * IPV6_FORWARDING flag to prevent infinite recursion.
69991ec0a1eSYoshinobu Inoue 			 *
70091ec0a1eSYoshinobu Inoue 			 * Multicasts that are looped back by ip6_mloopback(),
70191ec0a1eSYoshinobu Inoue 			 * above, will be forwarded by the ip6_input() routine,
70291ec0a1eSYoshinobu Inoue 			 * if necessary.
70391ec0a1eSYoshinobu Inoue 			 */
70433cde130SBruce M Simpson 			if (V_ip6_mrouter && (flags & IPV6_FORWARDING) == 0) {
705a1f7e5f8SHajimu UMEMOTO 				/*
706a1f7e5f8SHajimu UMEMOTO 				 * XXX: ip6_mforward expects that rcvif is NULL
707a1f7e5f8SHajimu UMEMOTO 				 * when it is called from the originating path.
708a1f7e5f8SHajimu UMEMOTO 				 * However, it is not always the case, since
709a1f7e5f8SHajimu UMEMOTO 				 * some versions of MGETHDR() does not
710a1f7e5f8SHajimu UMEMOTO 				 * initialize the field.
711a1f7e5f8SHajimu UMEMOTO 				 */
712a1f7e5f8SHajimu UMEMOTO 				m->m_pkthdr.rcvif = NULL;
713686cdd19SJun-ichiro itojun Hagino 				if (ip6_mforward(ip6, ifp, m) != 0) {
71491ec0a1eSYoshinobu Inoue 					m_freem(m);
71591ec0a1eSYoshinobu Inoue 					goto done;
71691ec0a1eSYoshinobu Inoue 				}
71791ec0a1eSYoshinobu Inoue 			}
71882cd038dSYoshinobu Inoue 		}
71982cd038dSYoshinobu Inoue 		/*
72082cd038dSYoshinobu Inoue 		 * Multicasts with a hoplimit of zero may be looped back,
72182cd038dSYoshinobu Inoue 		 * above, but must not be transmitted on a network.
72282cd038dSYoshinobu Inoue 		 * Also, multicasts addressed to the loopback interface
72382cd038dSYoshinobu Inoue 		 * are not sent -- the above call to ip6_mloopback() will
72482cd038dSYoshinobu Inoue 		 * loop back a copy if this host actually belongs to the
72582cd038dSYoshinobu Inoue 		 * destination group on the loopback interface.
72682cd038dSYoshinobu Inoue 		 */
727f95d4633SHajimu UMEMOTO 		if (ip6->ip6_hlim == 0 || (ifp->if_flags & IFF_LOOPBACK) ||
728f95d4633SHajimu UMEMOTO 		    IN6_IS_ADDR_MC_INTFACELOCAL(&ip6->ip6_dst)) {
72982cd038dSYoshinobu Inoue 			m_freem(m);
73082cd038dSYoshinobu Inoue 			goto done;
73182cd038dSYoshinobu Inoue 		}
73282cd038dSYoshinobu Inoue 	}
73382cd038dSYoshinobu Inoue 
73482cd038dSYoshinobu Inoue 	/*
73582cd038dSYoshinobu Inoue 	 * Fill the outgoing inteface to tell the upper layer
73682cd038dSYoshinobu Inoue 	 * to increment per-interface statistics.
73782cd038dSYoshinobu Inoue 	 */
73882cd038dSYoshinobu Inoue 	if (ifpp)
73982cd038dSYoshinobu Inoue 		*ifpp = ifp;
74082cd038dSYoshinobu Inoue 
74131b3783cSHajimu UMEMOTO 	/* Determine path MTU. */
742f95d4633SHajimu UMEMOTO 	if ((error = ip6_getpmtu(ro_pmtu, ro, ifp, &finaldst, &mtu,
743f95d4633SHajimu UMEMOTO 	    &alwaysfrag)) != 0)
74431b3783cSHajimu UMEMOTO 		goto bad;
74582cd038dSYoshinobu Inoue 
74633841545SHajimu UMEMOTO 	/*
7478b00e59dSHajimu UMEMOTO 	 * The caller of this function may specify to use the minimum MTU
7488b00e59dSHajimu UMEMOTO 	 * in some cases.
7498b00e59dSHajimu UMEMOTO 	 * An advanced API option (IPV6_USE_MIN_MTU) can also override MTU
7508b00e59dSHajimu UMEMOTO 	 * setting.  The logic is a bit complicated; by default, unicast
7518b00e59dSHajimu UMEMOTO 	 * packets will follow path MTU while multicast packets will be sent at
7528b00e59dSHajimu UMEMOTO 	 * the minimum MTU.  If IP6PO_MINMTU_ALL is specified, all packets
7538b00e59dSHajimu UMEMOTO 	 * including unicast ones will be sent at the minimum MTU.  Multicast
7548b00e59dSHajimu UMEMOTO 	 * packets will always be sent at the minimum MTU unless
7558b00e59dSHajimu UMEMOTO 	 * IP6PO_MINMTU_DISABLE is explicitly specified.
7568b00e59dSHajimu UMEMOTO 	 * See RFC 3542 for more details.
75733841545SHajimu UMEMOTO 	 */
7588b00e59dSHajimu UMEMOTO 	if (mtu > IPV6_MMTU) {
7598b00e59dSHajimu UMEMOTO 		if ((flags & IPV6_MINMTU))
76033841545SHajimu UMEMOTO 			mtu = IPV6_MMTU;
7618b00e59dSHajimu UMEMOTO 		else if (opt && opt->ip6po_minmtu == IP6PO_MINMTU_ALL)
7628b00e59dSHajimu UMEMOTO 			mtu = IPV6_MMTU;
7638b00e59dSHajimu UMEMOTO 		else if (IN6_IS_ADDR_MULTICAST(&ip6->ip6_dst) &&
7648b00e59dSHajimu UMEMOTO 			 (opt == NULL ||
7658b00e59dSHajimu UMEMOTO 			  opt->ip6po_minmtu != IP6PO_MINMTU_DISABLE)) {
7668b00e59dSHajimu UMEMOTO 			mtu = IPV6_MMTU;
7678b00e59dSHajimu UMEMOTO 		}
7688b00e59dSHajimu UMEMOTO 	}
76933841545SHajimu UMEMOTO 
77033841545SHajimu UMEMOTO 	/*
77133841545SHajimu UMEMOTO 	 * clear embedded scope identifiers if necessary.
77233841545SHajimu UMEMOTO 	 * in6_clearscope will touch the addresses only when necessary.
77333841545SHajimu UMEMOTO 	 */
77433841545SHajimu UMEMOTO 	in6_clearscope(&ip6->ip6_src);
77533841545SHajimu UMEMOTO 	in6_clearscope(&ip6->ip6_dst);
77682cd038dSYoshinobu Inoue 
77782cd038dSYoshinobu Inoue 	/*
77882cd038dSYoshinobu Inoue 	 * If the outgoing packet contains a hop-by-hop options header,
77982cd038dSYoshinobu Inoue 	 * it must be examined and processed even by the source node.
78082cd038dSYoshinobu Inoue 	 * (RFC 2460, section 4.)
78182cd038dSYoshinobu Inoue 	 */
78282cd038dSYoshinobu Inoue 	if (exthdrs.ip6e_hbh) {
78333841545SHajimu UMEMOTO 		struct ip6_hbh *hbh = mtod(exthdrs.ip6e_hbh, struct ip6_hbh *);
784283f9f8aSHajimu UMEMOTO 		u_int32_t dummy; /* XXX unused */
785283f9f8aSHajimu UMEMOTO 		u_int32_t plen = 0; /* XXX: ip6_process will check the value */
78682cd038dSYoshinobu Inoue 
78733841545SHajimu UMEMOTO #ifdef DIAGNOSTIC
78833841545SHajimu UMEMOTO 		if ((hbh->ip6h_len + 1) << 3 > exthdrs.ip6e_hbh->m_len)
78933841545SHajimu UMEMOTO 			panic("ip6e_hbh is not continuous");
79033841545SHajimu UMEMOTO #endif
79182cd038dSYoshinobu Inoue 		/*
79282cd038dSYoshinobu Inoue 		 *  XXX: if we have to send an ICMPv6 error to the sender,
79382cd038dSYoshinobu Inoue 		 *       we need the M_LOOP flag since icmp6_error() expects
79482cd038dSYoshinobu Inoue 		 *       the IPv6 and the hop-by-hop options header are
79582cd038dSYoshinobu Inoue 		 *       continuous unless the flag is set.
79682cd038dSYoshinobu Inoue 		 */
79782cd038dSYoshinobu Inoue 		m->m_flags |= M_LOOP;
79882cd038dSYoshinobu Inoue 		m->m_pkthdr.rcvif = ifp;
7997efe5d92SHajimu UMEMOTO 		if (ip6_process_hopopts(m, (u_int8_t *)(hbh + 1),
8007efe5d92SHajimu UMEMOTO 		    ((hbh->ip6h_len + 1) << 3) - sizeof(struct ip6_hbh),
801283f9f8aSHajimu UMEMOTO 		    &dummy, &plen) < 0) {
80282cd038dSYoshinobu Inoue 			/* m was already freed at this point */
80382cd038dSYoshinobu Inoue 			error = EINVAL;/* better error? */
80482cd038dSYoshinobu Inoue 			goto done;
80582cd038dSYoshinobu Inoue 		}
80682cd038dSYoshinobu Inoue 		m->m_flags &= ~M_LOOP; /* XXX */
80782cd038dSYoshinobu Inoue 		m->m_pkthdr.rcvif = NULL;
80882cd038dSYoshinobu Inoue 	}
80982cd038dSYoshinobu Inoue 
810c21fd232SAndre Oppermann 	/* Jump over all PFIL processing if hooks are not active. */
811604afec4SChristian S.J. Peron 	if (!PFIL_HOOKED(&inet6_pfil_hook))
812c21fd232SAndre Oppermann 		goto passout;
813c21fd232SAndre Oppermann 
8148195404bSBrooks Davis 	odst = ip6->ip6_dst;
815c21fd232SAndre Oppermann 	/* Run through list of hooks for output packets. */
816d6a8d588SMax Laier 	error = pfil_run_hooks(&inet6_pfil_hook, &m, ifp, PFIL_OUT, inp);
817b140bc1fSSam Leffler 	if (error != 0 || m == NULL)
818c4ac87eaSDarren Reed 		goto done;
819c4ac87eaSDarren Reed 	ip6 = mtod(m, struct ip6_hdr *);
8207efe5d92SHajimu UMEMOTO 
8218195404bSBrooks Davis 	/* See if destination IP address was changed by packet filter. */
8228195404bSBrooks Davis 	if (!IN6_ARE_ADDR_EQUAL(&odst, &ip6->ip6_dst)) {
8238195404bSBrooks Davis 		m->m_flags |= M_SKIP_FIREWALL;
8248195404bSBrooks Davis 		/* If destination is now ourself drop to ip6_input(). */
8258195404bSBrooks Davis 		if (in6_localaddr(&ip6->ip6_dst)) {
8268195404bSBrooks Davis 			if (m->m_pkthdr.rcvif == NULL)
827603724d3SBjoern A. Zeeb 				m->m_pkthdr.rcvif = V_loif;
8288195404bSBrooks Davis 			if (m->m_pkthdr.csum_flags & CSUM_DELAY_DATA) {
8298195404bSBrooks Davis 				m->m_pkthdr.csum_flags |=
8308195404bSBrooks Davis 				    CSUM_DATA_VALID | CSUM_PSEUDO_HDR;
8318195404bSBrooks Davis 				m->m_pkthdr.csum_data = 0xffff;
8328195404bSBrooks Davis 			}
8338195404bSBrooks Davis 			m->m_pkthdr.csum_flags |=
8348195404bSBrooks Davis 			    CSUM_IP_CHECKED | CSUM_IP_VALID;
8358195404bSBrooks Davis 			error = netisr_queue(NETISR_IPV6, m);
8368195404bSBrooks Davis 			goto done;
8378195404bSBrooks Davis 		} else
8388195404bSBrooks Davis 			goto again;	/* Redo the routing table lookup. */
8398195404bSBrooks Davis 	}
8408195404bSBrooks Davis 
8418195404bSBrooks Davis 	/* XXX: IPFIREWALL_FORWARD */
8428195404bSBrooks Davis 
843c21fd232SAndre Oppermann passout:
84482cd038dSYoshinobu Inoue 	/*
84582cd038dSYoshinobu Inoue 	 * Send the packet to the outgoing interface.
84682cd038dSYoshinobu Inoue 	 * If necessary, do IPv6 fragmentation before sending.
847f95d4633SHajimu UMEMOTO 	 *
848f95d4633SHajimu UMEMOTO 	 * the logic here is rather complex:
849f95d4633SHajimu UMEMOTO 	 * 1: normal case (dontfrag == 0, alwaysfrag == 0)
850f95d4633SHajimu UMEMOTO 	 * 1-a:	send as is if tlen <= path mtu
851f95d4633SHajimu UMEMOTO 	 * 1-b:	fragment if tlen > path mtu
852f95d4633SHajimu UMEMOTO 	 *
853f95d4633SHajimu UMEMOTO 	 * 2: if user asks us not to fragment (dontfrag == 1)
854f95d4633SHajimu UMEMOTO 	 * 2-a:	send as is if tlen <= interface mtu
855f95d4633SHajimu UMEMOTO 	 * 2-b:	error if tlen > interface mtu
856f95d4633SHajimu UMEMOTO 	 *
857f95d4633SHajimu UMEMOTO 	 * 3: if we always need to attach fragment header (alwaysfrag == 1)
858f95d4633SHajimu UMEMOTO 	 *	always fragment
859f95d4633SHajimu UMEMOTO 	 *
860f95d4633SHajimu UMEMOTO 	 * 4: if dontfrag == 1 && alwaysfrag == 1
861f95d4633SHajimu UMEMOTO 	 *	error, as we cannot handle this conflicting request
86282cd038dSYoshinobu Inoue 	 */
86382cd038dSYoshinobu Inoue 	tlen = m->m_pkthdr.len;
86482cd038dSYoshinobu Inoue 
865f95d4633SHajimu UMEMOTO 	if (opt && (opt->ip6po_flags & IP6PO_DONTFRAG))
866f95d4633SHajimu UMEMOTO 		dontfrag = 1;
867f95d4633SHajimu UMEMOTO 	else
868f95d4633SHajimu UMEMOTO 		dontfrag = 0;
869f95d4633SHajimu UMEMOTO 	if (dontfrag && alwaysfrag) {	/* case 4 */
870f95d4633SHajimu UMEMOTO 		/* conflicting request - can't transmit */
871f95d4633SHajimu UMEMOTO 		error = EMSGSIZE;
872f95d4633SHajimu UMEMOTO 		goto bad;
873f95d4633SHajimu UMEMOTO 	}
874f95d4633SHajimu UMEMOTO 	if (dontfrag && tlen > IN6_LINKMTU(ifp)) {	/* case 2-b */
875f95d4633SHajimu UMEMOTO 		/*
876f95d4633SHajimu UMEMOTO 		 * Even if the DONTFRAG option is specified, we cannot send the
877f95d4633SHajimu UMEMOTO 		 * packet when the data length is larger than the MTU of the
878f95d4633SHajimu UMEMOTO 		 * outgoing interface.
879f95d4633SHajimu UMEMOTO 		 * Notify the error by sending IPV6_PATHMTU ancillary data as
880f95d4633SHajimu UMEMOTO 		 * well as returning an error code (the latter is not described
881f95d4633SHajimu UMEMOTO 		 * in the API spec.)
882f95d4633SHajimu UMEMOTO 		 */
883f95d4633SHajimu UMEMOTO 		u_int32_t mtu32;
884f95d4633SHajimu UMEMOTO 		struct ip6ctlparam ip6cp;
885f95d4633SHajimu UMEMOTO 
886f95d4633SHajimu UMEMOTO 		mtu32 = (u_int32_t)mtu;
887f95d4633SHajimu UMEMOTO 		bzero(&ip6cp, sizeof(ip6cp));
888f95d4633SHajimu UMEMOTO 		ip6cp.ip6c_cmdarg = (void *)&mtu32;
889f95d4633SHajimu UMEMOTO 		pfctlinput2(PRC_MSGSIZE, (struct sockaddr *)&ro_pmtu->ro_dst,
890f95d4633SHajimu UMEMOTO 		    (void *)&ip6cp);
891f95d4633SHajimu UMEMOTO 
892f95d4633SHajimu UMEMOTO 		error = EMSGSIZE;
893f95d4633SHajimu UMEMOTO 		goto bad;
894f95d4633SHajimu UMEMOTO 	}
895f95d4633SHajimu UMEMOTO 
896f95d4633SHajimu UMEMOTO 	/*
897f95d4633SHajimu UMEMOTO 	 * transmit packet without fragmentation
898f95d4633SHajimu UMEMOTO 	 */
899f95d4633SHajimu UMEMOTO 	if (dontfrag || (!alwaysfrag && tlen <= mtu)) {	/* case 1-a and 2-a */
900f95d4633SHajimu UMEMOTO 		struct in6_ifaddr *ia6;
901f95d4633SHajimu UMEMOTO 
902f95d4633SHajimu UMEMOTO 		ip6 = mtod(m, struct ip6_hdr *);
903f95d4633SHajimu UMEMOTO 		ia6 = in6_ifawithifp(ifp, &ip6->ip6_src);
904f95d4633SHajimu UMEMOTO 		if (ia6) {
9055da9f8faSJosef Karthauser 			/* Record statistics for this interface address. */
906f95d4633SHajimu UMEMOTO 			ia6->ia_ifa.if_opackets++;
907f95d4633SHajimu UMEMOTO 			ia6->ia_ifa.if_obytes += m->m_pkthdr.len;
9085da9f8faSJosef Karthauser 		}
909686cdd19SJun-ichiro itojun Hagino 		error = nd6_output(ifp, origifp, m, dst, ro->ro_rt);
91082cd038dSYoshinobu Inoue 		goto done;
911f95d4633SHajimu UMEMOTO 	}
912f95d4633SHajimu UMEMOTO 
91382cd038dSYoshinobu Inoue 	/*
914f95d4633SHajimu UMEMOTO 	 * try to fragment the packet.  case 1-b and 3
91582cd038dSYoshinobu Inoue 	 */
916f95d4633SHajimu UMEMOTO 	if (mtu < IPV6_MMTU) {
917f95d4633SHajimu UMEMOTO 		/* path MTU cannot be less than IPV6_MMTU */
91882cd038dSYoshinobu Inoue 		error = EMSGSIZE;
91982cd038dSYoshinobu Inoue 		in6_ifstat_inc(ifp, ifs6_out_fragfail);
92082cd038dSYoshinobu Inoue 		goto bad;
9217efe5d92SHajimu UMEMOTO 	} else if (ip6->ip6_plen == 0) {
9227efe5d92SHajimu UMEMOTO 		/* jumbo payload cannot be fragmented */
92382cd038dSYoshinobu Inoue 		error = EMSGSIZE;
92482cd038dSYoshinobu Inoue 		in6_ifstat_inc(ifp, ifs6_out_fragfail);
92582cd038dSYoshinobu Inoue 		goto bad;
92682cd038dSYoshinobu Inoue 	} else {
92782cd038dSYoshinobu Inoue 		struct mbuf **mnext, *m_frgpart;
92882cd038dSYoshinobu Inoue 		struct ip6_frag *ip6f;
9298373d51dSHajimu UMEMOTO 		u_int32_t id = htonl(ip6_randomid());
93082cd038dSYoshinobu Inoue 		u_char nextproto;
9312cb64cb2SGeorge V. Neville-Neil 
9326f8aee22SBill Paul 		int qslots = ifp->if_snd.ifq_maxlen - ifp->if_snd.ifq_len;
93382cd038dSYoshinobu Inoue 
93482cd038dSYoshinobu Inoue 		/*
93582cd038dSYoshinobu Inoue 		 * Too large for the destination or interface;
93682cd038dSYoshinobu Inoue 		 * fragment if possible.
93782cd038dSYoshinobu Inoue 		 * Must be able to put at least 8 bytes per fragment.
93882cd038dSYoshinobu Inoue 		 */
93982cd038dSYoshinobu Inoue 		hlen = unfragpartlen;
94082cd038dSYoshinobu Inoue 		if (mtu > IPV6_MAXPACKET)
94182cd038dSYoshinobu Inoue 			mtu = IPV6_MAXPACKET;
94233841545SHajimu UMEMOTO 
94382cd038dSYoshinobu Inoue 		len = (mtu - hlen - sizeof(struct ip6_frag)) & ~7;
94482cd038dSYoshinobu Inoue 		if (len < 8) {
94582cd038dSYoshinobu Inoue 			error = EMSGSIZE;
94682cd038dSYoshinobu Inoue 			in6_ifstat_inc(ifp, ifs6_out_fragfail);
94782cd038dSYoshinobu Inoue 			goto bad;
94882cd038dSYoshinobu Inoue 		}
94982cd038dSYoshinobu Inoue 
9506f8aee22SBill Paul 		/*
9516f8aee22SBill Paul 		 * Verify that we have any chance at all of being able to queue
9526f8aee22SBill Paul 		 *      the packet or packet fragments
9536f8aee22SBill Paul 		 */
9546f8aee22SBill Paul 		if (qslots <= 0 || ((u_int)qslots * (mtu - hlen)
9556f8aee22SBill Paul 		    < tlen  /* - hlen */)) {
9566f8aee22SBill Paul 			error = ENOBUFS;
957603724d3SBjoern A. Zeeb 			V_ip6stat.ip6s_odropped++;
9586f8aee22SBill Paul 			goto bad;
9596f8aee22SBill Paul 		}
9606f8aee22SBill Paul 
96182cd038dSYoshinobu Inoue 		mnext = &m->m_nextpkt;
96282cd038dSYoshinobu Inoue 
96382cd038dSYoshinobu Inoue 		/*
96482cd038dSYoshinobu Inoue 		 * Change the next header field of the last header in the
96582cd038dSYoshinobu Inoue 		 * unfragmentable part.
96682cd038dSYoshinobu Inoue 		 */
96782cd038dSYoshinobu Inoue 		if (exthdrs.ip6e_rthdr) {
96882cd038dSYoshinobu Inoue 			nextproto = *mtod(exthdrs.ip6e_rthdr, u_char *);
96982cd038dSYoshinobu Inoue 			*mtod(exthdrs.ip6e_rthdr, u_char *) = IPPROTO_FRAGMENT;
97082cd038dSYoshinobu Inoue 		} else if (exthdrs.ip6e_dest1) {
97182cd038dSYoshinobu Inoue 			nextproto = *mtod(exthdrs.ip6e_dest1, u_char *);
97282cd038dSYoshinobu Inoue 			*mtod(exthdrs.ip6e_dest1, u_char *) = IPPROTO_FRAGMENT;
97382cd038dSYoshinobu Inoue 		} else if (exthdrs.ip6e_hbh) {
97482cd038dSYoshinobu Inoue 			nextproto = *mtod(exthdrs.ip6e_hbh, u_char *);
97582cd038dSYoshinobu Inoue 			*mtod(exthdrs.ip6e_hbh, u_char *) = IPPROTO_FRAGMENT;
97682cd038dSYoshinobu Inoue 		} else {
97782cd038dSYoshinobu Inoue 			nextproto = ip6->ip6_nxt;
97882cd038dSYoshinobu Inoue 			ip6->ip6_nxt = IPPROTO_FRAGMENT;
97982cd038dSYoshinobu Inoue 		}
98082cd038dSYoshinobu Inoue 
98182cd038dSYoshinobu Inoue 		/*
98282cd038dSYoshinobu Inoue 		 * Loop through length of segment after first fragment,
98388ff5695SSUZUKI Shinsuke 		 * make new header and copy data of each part and link onto
98488ff5695SSUZUKI Shinsuke 		 * chain.
98582cd038dSYoshinobu Inoue 		 */
98682cd038dSYoshinobu Inoue 		m0 = m;
98782cd038dSYoshinobu Inoue 		for (off = hlen; off < tlen; off += len) {
988a163d034SWarner Losh 			MGETHDR(m, M_DONTWAIT, MT_HEADER);
98982cd038dSYoshinobu Inoue 			if (!m) {
99082cd038dSYoshinobu Inoue 				error = ENOBUFS;
991603724d3SBjoern A. Zeeb 				V_ip6stat.ip6s_odropped++;
99282cd038dSYoshinobu Inoue 				goto sendorfree;
99382cd038dSYoshinobu Inoue 			}
99433841545SHajimu UMEMOTO 			m->m_pkthdr.rcvif = NULL;
99582cd038dSYoshinobu Inoue 			m->m_flags = m0->m_flags & M_COPYFLAGS;
99682cd038dSYoshinobu Inoue 			*mnext = m;
99782cd038dSYoshinobu Inoue 			mnext = &m->m_nextpkt;
99882cd038dSYoshinobu Inoue 			m->m_data += max_linkhdr;
99982cd038dSYoshinobu Inoue 			mhip6 = mtod(m, struct ip6_hdr *);
100082cd038dSYoshinobu Inoue 			*mhip6 = *ip6;
100182cd038dSYoshinobu Inoue 			m->m_len = sizeof(*mhip6);
100282cd038dSYoshinobu Inoue 			error = ip6_insertfraghdr(m0, m, hlen, &ip6f);
100382cd038dSYoshinobu Inoue 			if (error) {
1004603724d3SBjoern A. Zeeb 				V_ip6stat.ip6s_odropped++;
100582cd038dSYoshinobu Inoue 				goto sendorfree;
100682cd038dSYoshinobu Inoue 			}
100782cd038dSYoshinobu Inoue 			ip6f->ip6f_offlg = htons((u_short)((off - hlen) & ~7));
100882cd038dSYoshinobu Inoue 			if (off + len >= tlen)
100982cd038dSYoshinobu Inoue 				len = tlen - off;
101082cd038dSYoshinobu Inoue 			else
101182cd038dSYoshinobu Inoue 				ip6f->ip6f_offlg |= IP6F_MORE_FRAG;
101282cd038dSYoshinobu Inoue 			mhip6->ip6_plen = htons((u_short)(len + hlen +
10137efe5d92SHajimu UMEMOTO 			    sizeof(*ip6f) - sizeof(struct ip6_hdr)));
101482cd038dSYoshinobu Inoue 			if ((m_frgpart = m_copy(m0, off, len)) == 0) {
101582cd038dSYoshinobu Inoue 				error = ENOBUFS;
1016603724d3SBjoern A. Zeeb 				V_ip6stat.ip6s_odropped++;
101782cd038dSYoshinobu Inoue 				goto sendorfree;
101882cd038dSYoshinobu Inoue 			}
101982cd038dSYoshinobu Inoue 			m_cat(m, m_frgpart);
102082cd038dSYoshinobu Inoue 			m->m_pkthdr.len = len + hlen + sizeof(*ip6f);
1021fc74a9f9SBrooks Davis 			m->m_pkthdr.rcvif = NULL;
102282cd038dSYoshinobu Inoue 			ip6f->ip6f_reserved = 0;
102382cd038dSYoshinobu Inoue 			ip6f->ip6f_ident = id;
102482cd038dSYoshinobu Inoue 			ip6f->ip6f_nxt = nextproto;
1025603724d3SBjoern A. Zeeb 			V_ip6stat.ip6s_ofragments++;
102682cd038dSYoshinobu Inoue 			in6_ifstat_inc(ifp, ifs6_out_fragcreat);
102782cd038dSYoshinobu Inoue 		}
102882cd038dSYoshinobu Inoue 
102982cd038dSYoshinobu Inoue 		in6_ifstat_inc(ifp, ifs6_out_fragok);
103082cd038dSYoshinobu Inoue 	}
103182cd038dSYoshinobu Inoue 
103282cd038dSYoshinobu Inoue 	/*
103382cd038dSYoshinobu Inoue 	 * Remove leading garbages.
103482cd038dSYoshinobu Inoue 	 */
103582cd038dSYoshinobu Inoue sendorfree:
103682cd038dSYoshinobu Inoue 	m = m0->m_nextpkt;
103782cd038dSYoshinobu Inoue 	m0->m_nextpkt = 0;
103882cd038dSYoshinobu Inoue 	m_freem(m0);
103982cd038dSYoshinobu Inoue 	for (m0 = m; m; m = m0) {
104082cd038dSYoshinobu Inoue 		m0 = m->m_nextpkt;
104182cd038dSYoshinobu Inoue 		m->m_nextpkt = 0;
104282cd038dSYoshinobu Inoue 		if (error == 0) {
1043fe937674SJosef Karthauser 			/* Record statistics for this interface address. */
1044fe937674SJosef Karthauser 			if (ia) {
1045fe937674SJosef Karthauser 				ia->ia_ifa.if_opackets++;
1046fe937674SJosef Karthauser 				ia->ia_ifa.if_obytes += m->m_pkthdr.len;
1047fe937674SJosef Karthauser 			}
1048686cdd19SJun-ichiro itojun Hagino 			error = nd6_output(ifp, origifp, m, dst, ro->ro_rt);
104982cd038dSYoshinobu Inoue 		} else
105082cd038dSYoshinobu Inoue 			m_freem(m);
105182cd038dSYoshinobu Inoue 	}
105282cd038dSYoshinobu Inoue 
105382cd038dSYoshinobu Inoue 	if (error == 0)
1054603724d3SBjoern A. Zeeb 		V_ip6stat.ip6s_fragmented++;
105582cd038dSYoshinobu Inoue 
105682cd038dSYoshinobu Inoue done:
105782cd038dSYoshinobu Inoue 	if (ro == &ip6route && ro->ro_rt) { /* brace necessary for RTFREE */
105882cd038dSYoshinobu Inoue 		RTFREE(ro->ro_rt);
105982cd038dSYoshinobu Inoue 	} else if (ro_pmtu == &ip6route && ro_pmtu->ro_rt) {
106082cd038dSYoshinobu Inoue 		RTFREE(ro_pmtu->ro_rt);
106182cd038dSYoshinobu Inoue 	}
10628cfbd299SBjoern A. Zeeb #ifdef IPSEC
10638cfbd299SBjoern A. Zeeb 	if (sp != NULL)
10648cfbd299SBjoern A. Zeeb 		KEY_FREESP(&sp);
10658cfbd299SBjoern A. Zeeb #endif
106682cd038dSYoshinobu Inoue 
106782cd038dSYoshinobu Inoue 	return (error);
106882cd038dSYoshinobu Inoue 
106982cd038dSYoshinobu Inoue freehdrs:
107082cd038dSYoshinobu Inoue 	m_freem(exthdrs.ip6e_hbh);	/* m_freem will check if mbuf is 0 */
107182cd038dSYoshinobu Inoue 	m_freem(exthdrs.ip6e_dest1);
107282cd038dSYoshinobu Inoue 	m_freem(exthdrs.ip6e_rthdr);
107382cd038dSYoshinobu Inoue 	m_freem(exthdrs.ip6e_dest2);
10747efe5d92SHajimu UMEMOTO 	/* FALLTHROUGH */
107582cd038dSYoshinobu Inoue bad:
10762cb64cb2SGeorge V. Neville-Neil 	if (m)
107782cd038dSYoshinobu Inoue 		m_freem(m);
107882cd038dSYoshinobu Inoue 	goto done;
107982cd038dSYoshinobu Inoue }
108082cd038dSYoshinobu Inoue 
108182cd038dSYoshinobu Inoue static int
10821272577eSXin LI ip6_copyexthdr(struct mbuf **mp, caddr_t hdr, int hlen)
108382cd038dSYoshinobu Inoue {
108482cd038dSYoshinobu Inoue 	struct mbuf *m;
108582cd038dSYoshinobu Inoue 
108682cd038dSYoshinobu Inoue 	if (hlen > MCLBYTES)
108782cd038dSYoshinobu Inoue 		return (ENOBUFS); /* XXX */
108882cd038dSYoshinobu Inoue 
1089a163d034SWarner Losh 	MGET(m, M_DONTWAIT, MT_DATA);
109082cd038dSYoshinobu Inoue 	if (!m)
109182cd038dSYoshinobu Inoue 		return (ENOBUFS);
109282cd038dSYoshinobu Inoue 
109382cd038dSYoshinobu Inoue 	if (hlen > MLEN) {
1094a163d034SWarner Losh 		MCLGET(m, M_DONTWAIT);
109582cd038dSYoshinobu Inoue 		if ((m->m_flags & M_EXT) == 0) {
109682cd038dSYoshinobu Inoue 			m_free(m);
109782cd038dSYoshinobu Inoue 			return (ENOBUFS);
109882cd038dSYoshinobu Inoue 		}
109982cd038dSYoshinobu Inoue 	}
110082cd038dSYoshinobu Inoue 	m->m_len = hlen;
110182cd038dSYoshinobu Inoue 	if (hdr)
110282cd038dSYoshinobu Inoue 		bcopy(hdr, mtod(m, caddr_t), hlen);
110382cd038dSYoshinobu Inoue 
110482cd038dSYoshinobu Inoue 	*mp = m;
110582cd038dSYoshinobu Inoue 	return (0);
110682cd038dSYoshinobu Inoue }
110782cd038dSYoshinobu Inoue 
110882cd038dSYoshinobu Inoue /*
110982cd038dSYoshinobu Inoue  * Insert jumbo payload option.
111082cd038dSYoshinobu Inoue  */
111182cd038dSYoshinobu Inoue static int
11121272577eSXin LI ip6_insert_jumboopt(struct ip6_exthdrs *exthdrs, u_int32_t plen)
111382cd038dSYoshinobu Inoue {
111482cd038dSYoshinobu Inoue 	struct mbuf *mopt;
111582cd038dSYoshinobu Inoue 	u_char *optbuf;
111633841545SHajimu UMEMOTO 	u_int32_t v;
111782cd038dSYoshinobu Inoue 
111882cd038dSYoshinobu Inoue #define JUMBOOPTLEN	8	/* length of jumbo payload option and padding */
111982cd038dSYoshinobu Inoue 
112082cd038dSYoshinobu Inoue 	/*
112182cd038dSYoshinobu Inoue 	 * If there is no hop-by-hop options header, allocate new one.
112282cd038dSYoshinobu Inoue 	 * If there is one but it doesn't have enough space to store the
112382cd038dSYoshinobu Inoue 	 * jumbo payload option, allocate a cluster to store the whole options.
112482cd038dSYoshinobu Inoue 	 * Otherwise, use it to store the options.
112582cd038dSYoshinobu Inoue 	 */
112682cd038dSYoshinobu Inoue 	if (exthdrs->ip6e_hbh == 0) {
1127a163d034SWarner Losh 		MGET(mopt, M_DONTWAIT, MT_DATA);
112882cd038dSYoshinobu Inoue 		if (mopt == 0)
112982cd038dSYoshinobu Inoue 			return (ENOBUFS);
113082cd038dSYoshinobu Inoue 		mopt->m_len = JUMBOOPTLEN;
113182cd038dSYoshinobu Inoue 		optbuf = mtod(mopt, u_char *);
113282cd038dSYoshinobu Inoue 		optbuf[1] = 0;	/* = ((JUMBOOPTLEN) >> 3) - 1 */
113382cd038dSYoshinobu Inoue 		exthdrs->ip6e_hbh = mopt;
113482cd038dSYoshinobu Inoue 	} else {
113582cd038dSYoshinobu Inoue 		struct ip6_hbh *hbh;
113682cd038dSYoshinobu Inoue 
113782cd038dSYoshinobu Inoue 		mopt = exthdrs->ip6e_hbh;
113882cd038dSYoshinobu Inoue 		if (M_TRAILINGSPACE(mopt) < JUMBOOPTLEN) {
113933841545SHajimu UMEMOTO 			/*
114033841545SHajimu UMEMOTO 			 * XXX assumption:
114133841545SHajimu UMEMOTO 			 * - exthdrs->ip6e_hbh is not referenced from places
114233841545SHajimu UMEMOTO 			 *   other than exthdrs.
114333841545SHajimu UMEMOTO 			 * - exthdrs->ip6e_hbh is not an mbuf chain.
114433841545SHajimu UMEMOTO 			 */
114582cd038dSYoshinobu Inoue 			int oldoptlen = mopt->m_len;
114633841545SHajimu UMEMOTO 			struct mbuf *n;
114782cd038dSYoshinobu Inoue 
114833841545SHajimu UMEMOTO 			/*
114933841545SHajimu UMEMOTO 			 * XXX: give up if the whole (new) hbh header does
115033841545SHajimu UMEMOTO 			 * not fit even in an mbuf cluster.
115133841545SHajimu UMEMOTO 			 */
115233841545SHajimu UMEMOTO 			if (oldoptlen + JUMBOOPTLEN > MCLBYTES)
115382cd038dSYoshinobu Inoue 				return (ENOBUFS);
115482cd038dSYoshinobu Inoue 
115533841545SHajimu UMEMOTO 			/*
115633841545SHajimu UMEMOTO 			 * As a consequence, we must always prepare a cluster
115733841545SHajimu UMEMOTO 			 * at this point.
115833841545SHajimu UMEMOTO 			 */
1159a163d034SWarner Losh 			MGET(n, M_DONTWAIT, MT_DATA);
116033841545SHajimu UMEMOTO 			if (n) {
1161a163d034SWarner Losh 				MCLGET(n, M_DONTWAIT);
116233841545SHajimu UMEMOTO 				if ((n->m_flags & M_EXT) == 0) {
116333841545SHajimu UMEMOTO 					m_freem(n);
116433841545SHajimu UMEMOTO 					n = NULL;
116533841545SHajimu UMEMOTO 				}
116633841545SHajimu UMEMOTO 			}
116733841545SHajimu UMEMOTO 			if (!n)
116833841545SHajimu UMEMOTO 				return (ENOBUFS);
116933841545SHajimu UMEMOTO 			n->m_len = oldoptlen + JUMBOOPTLEN;
117033841545SHajimu UMEMOTO 			bcopy(mtod(mopt, caddr_t), mtod(n, caddr_t),
117133841545SHajimu UMEMOTO 			    oldoptlen);
117233841545SHajimu UMEMOTO 			optbuf = mtod(n, caddr_t) + oldoptlen;
117333841545SHajimu UMEMOTO 			m_freem(mopt);
117433841545SHajimu UMEMOTO 			mopt = exthdrs->ip6e_hbh = n;
117582cd038dSYoshinobu Inoue 		} else {
117682cd038dSYoshinobu Inoue 			optbuf = mtod(mopt, u_char *) + mopt->m_len;
117782cd038dSYoshinobu Inoue 			mopt->m_len += JUMBOOPTLEN;
117882cd038dSYoshinobu Inoue 		}
117982cd038dSYoshinobu Inoue 		optbuf[0] = IP6OPT_PADN;
118082cd038dSYoshinobu Inoue 		optbuf[1] = 1;
118182cd038dSYoshinobu Inoue 
118282cd038dSYoshinobu Inoue 		/*
118382cd038dSYoshinobu Inoue 		 * Adjust the header length according to the pad and
118482cd038dSYoshinobu Inoue 		 * the jumbo payload option.
118582cd038dSYoshinobu Inoue 		 */
118682cd038dSYoshinobu Inoue 		hbh = mtod(mopt, struct ip6_hbh *);
118782cd038dSYoshinobu Inoue 		hbh->ip6h_len += (JUMBOOPTLEN >> 3);
118882cd038dSYoshinobu Inoue 	}
118982cd038dSYoshinobu Inoue 
119082cd038dSYoshinobu Inoue 	/* fill in the option. */
119182cd038dSYoshinobu Inoue 	optbuf[2] = IP6OPT_JUMBO;
119282cd038dSYoshinobu Inoue 	optbuf[3] = 4;
119333841545SHajimu UMEMOTO 	v = (u_int32_t)htonl(plen + JUMBOOPTLEN);
119433841545SHajimu UMEMOTO 	bcopy(&v, &optbuf[4], sizeof(u_int32_t));
119582cd038dSYoshinobu Inoue 
119682cd038dSYoshinobu Inoue 	/* finally, adjust the packet header length */
119782cd038dSYoshinobu Inoue 	exthdrs->ip6e_ip6->m_pkthdr.len += JUMBOOPTLEN;
119882cd038dSYoshinobu Inoue 
119982cd038dSYoshinobu Inoue 	return (0);
120082cd038dSYoshinobu Inoue #undef JUMBOOPTLEN
120182cd038dSYoshinobu Inoue }
120282cd038dSYoshinobu Inoue 
120382cd038dSYoshinobu Inoue /*
120482cd038dSYoshinobu Inoue  * Insert fragment header and copy unfragmentable header portions.
120582cd038dSYoshinobu Inoue  */
120682cd038dSYoshinobu Inoue static int
12071272577eSXin LI ip6_insertfraghdr(struct mbuf *m0, struct mbuf *m, int hlen,
12081272577eSXin LI     struct ip6_frag **frghdrp)
120982cd038dSYoshinobu Inoue {
121082cd038dSYoshinobu Inoue 	struct mbuf *n, *mlast;
121182cd038dSYoshinobu Inoue 
121282cd038dSYoshinobu Inoue 	if (hlen > sizeof(struct ip6_hdr)) {
121382cd038dSYoshinobu Inoue 		n = m_copym(m0, sizeof(struct ip6_hdr),
1214a163d034SWarner Losh 		    hlen - sizeof(struct ip6_hdr), M_DONTWAIT);
121582cd038dSYoshinobu Inoue 		if (n == 0)
121682cd038dSYoshinobu Inoue 			return (ENOBUFS);
121782cd038dSYoshinobu Inoue 		m->m_next = n;
121882cd038dSYoshinobu Inoue 	} else
121982cd038dSYoshinobu Inoue 		n = m;
122082cd038dSYoshinobu Inoue 
122182cd038dSYoshinobu Inoue 	/* Search for the last mbuf of unfragmentable part. */
122282cd038dSYoshinobu Inoue 	for (mlast = n; mlast->m_next; mlast = mlast->m_next)
122382cd038dSYoshinobu Inoue 		;
122482cd038dSYoshinobu Inoue 
122582cd038dSYoshinobu Inoue 	if ((mlast->m_flags & M_EXT) == 0 &&
1226686cdd19SJun-ichiro itojun Hagino 	    M_TRAILINGSPACE(mlast) >= sizeof(struct ip6_frag)) {
122782cd038dSYoshinobu Inoue 		/* use the trailing space of the last mbuf for the fragment hdr */
12287efe5d92SHajimu UMEMOTO 		*frghdrp = (struct ip6_frag *)(mtod(mlast, caddr_t) +
12297efe5d92SHajimu UMEMOTO 		    mlast->m_len);
123082cd038dSYoshinobu Inoue 		mlast->m_len += sizeof(struct ip6_frag);
123182cd038dSYoshinobu Inoue 		m->m_pkthdr.len += sizeof(struct ip6_frag);
123282cd038dSYoshinobu Inoue 	} else {
123382cd038dSYoshinobu Inoue 		/* allocate a new mbuf for the fragment header */
123482cd038dSYoshinobu Inoue 		struct mbuf *mfrg;
123582cd038dSYoshinobu Inoue 
1236a163d034SWarner Losh 		MGET(mfrg, M_DONTWAIT, MT_DATA);
123782cd038dSYoshinobu Inoue 		if (mfrg == 0)
123882cd038dSYoshinobu Inoue 			return (ENOBUFS);
123982cd038dSYoshinobu Inoue 		mfrg->m_len = sizeof(struct ip6_frag);
124082cd038dSYoshinobu Inoue 		*frghdrp = mtod(mfrg, struct ip6_frag *);
124182cd038dSYoshinobu Inoue 		mlast->m_next = mfrg;
124282cd038dSYoshinobu Inoue 	}
124382cd038dSYoshinobu Inoue 
124482cd038dSYoshinobu Inoue 	return (0);
124582cd038dSYoshinobu Inoue }
124682cd038dSYoshinobu Inoue 
124731b3783cSHajimu UMEMOTO static int
12481272577eSXin LI ip6_getpmtu(struct route_in6 *ro_pmtu, struct route_in6 *ro,
12491272577eSXin LI     struct ifnet *ifp, struct in6_addr *dst, u_long *mtup,
12501272577eSXin LI     int *alwaysfragp)
125131b3783cSHajimu UMEMOTO {
125231b3783cSHajimu UMEMOTO 	u_int32_t mtu = 0;
1253f95d4633SHajimu UMEMOTO 	int alwaysfrag = 0;
125431b3783cSHajimu UMEMOTO 	int error = 0;
125531b3783cSHajimu UMEMOTO 
125631b3783cSHajimu UMEMOTO 	if (ro_pmtu != ro) {
125731b3783cSHajimu UMEMOTO 		/* The first hop and the final destination may differ. */
125831b3783cSHajimu UMEMOTO 		struct sockaddr_in6 *sa6_dst =
125931b3783cSHajimu UMEMOTO 		    (struct sockaddr_in6 *)&ro_pmtu->ro_dst;
126031b3783cSHajimu UMEMOTO 		if (ro_pmtu->ro_rt &&
1261e5f467a2SHajimu UMEMOTO 		    ((ro_pmtu->ro_rt->rt_flags & RTF_UP) == 0 ||
126231b3783cSHajimu UMEMOTO 		     !IN6_ARE_ADDR_EQUAL(&sa6_dst->sin6_addr, dst))) {
126331b3783cSHajimu UMEMOTO 			RTFREE(ro_pmtu->ro_rt);
126431b3783cSHajimu UMEMOTO 			ro_pmtu->ro_rt = (struct rtentry *)NULL;
126531b3783cSHajimu UMEMOTO 		}
126631b3783cSHajimu UMEMOTO 		if (ro_pmtu->ro_rt == NULL) {
126731b3783cSHajimu UMEMOTO 			bzero(sa6_dst, sizeof(*sa6_dst));
126831b3783cSHajimu UMEMOTO 			sa6_dst->sin6_family = AF_INET6;
126931b3783cSHajimu UMEMOTO 			sa6_dst->sin6_len = sizeof(struct sockaddr_in6);
127031b3783cSHajimu UMEMOTO 			sa6_dst->sin6_addr = *dst;
127131b3783cSHajimu UMEMOTO 
127231b3783cSHajimu UMEMOTO 			rtalloc((struct route *)ro_pmtu);
127331b3783cSHajimu UMEMOTO 		}
127431b3783cSHajimu UMEMOTO 	}
127531b3783cSHajimu UMEMOTO 	if (ro_pmtu->ro_rt) {
127631b3783cSHajimu UMEMOTO 		u_int32_t ifmtu;
127797d8d152SAndre Oppermann 		struct in_conninfo inc;
127897d8d152SAndre Oppermann 
127997d8d152SAndre Oppermann 		bzero(&inc, sizeof(inc));
1280dcdb4371SBjoern A. Zeeb 		inc.inc_flags |= INC_ISIPV6;
128197d8d152SAndre Oppermann 		inc.inc6_faddr = *dst;
128231b3783cSHajimu UMEMOTO 
128331b3783cSHajimu UMEMOTO 		if (ifp == NULL)
128431b3783cSHajimu UMEMOTO 			ifp = ro_pmtu->ro_rt->rt_ifp;
128531b3783cSHajimu UMEMOTO 		ifmtu = IN6_LINKMTU(ifp);
128697d8d152SAndre Oppermann 		mtu = tcp_hc_getmtu(&inc);
128797d8d152SAndre Oppermann 		if (mtu)
128897d8d152SAndre Oppermann 			mtu = min(mtu, ro_pmtu->ro_rt->rt_rmx.rmx_mtu);
128997d8d152SAndre Oppermann 		else
129031b3783cSHajimu UMEMOTO 			mtu = ro_pmtu->ro_rt->rt_rmx.rmx_mtu;
129131b3783cSHajimu UMEMOTO 		if (mtu == 0)
129231b3783cSHajimu UMEMOTO 			mtu = ifmtu;
1293f95d4633SHajimu UMEMOTO 		else if (mtu < IPV6_MMTU) {
1294f95d4633SHajimu UMEMOTO 			/*
1295f95d4633SHajimu UMEMOTO 			 * RFC2460 section 5, last paragraph:
1296f95d4633SHajimu UMEMOTO 			 * if we record ICMPv6 too big message with
1297f95d4633SHajimu UMEMOTO 			 * mtu < IPV6_MMTU, transmit packets sized IPV6_MMTU
1298f95d4633SHajimu UMEMOTO 			 * or smaller, with framgent header attached.
1299f95d4633SHajimu UMEMOTO 			 * (fragment header is needed regardless from the
1300f95d4633SHajimu UMEMOTO 			 * packet size, for translators to identify packets)
1301f95d4633SHajimu UMEMOTO 			 */
1302f95d4633SHajimu UMEMOTO 			alwaysfrag = 1;
1303f95d4633SHajimu UMEMOTO 			mtu = IPV6_MMTU;
1304f95d4633SHajimu UMEMOTO 		} else if (mtu > ifmtu) {
130531b3783cSHajimu UMEMOTO 			/*
130631b3783cSHajimu UMEMOTO 			 * The MTU on the route is larger than the MTU on
130731b3783cSHajimu UMEMOTO 			 * the interface!  This shouldn't happen, unless the
130831b3783cSHajimu UMEMOTO 			 * MTU of the interface has been changed after the
130931b3783cSHajimu UMEMOTO 			 * interface was brought up.  Change the MTU in the
131031b3783cSHajimu UMEMOTO 			 * route to match the interface MTU (as long as the
131131b3783cSHajimu UMEMOTO 			 * field isn't locked).
131231b3783cSHajimu UMEMOTO 			 */
131331b3783cSHajimu UMEMOTO 			mtu = ifmtu;
131431b3783cSHajimu UMEMOTO 			ro_pmtu->ro_rt->rt_rmx.rmx_mtu = mtu;
131531b3783cSHajimu UMEMOTO 		}
131631b3783cSHajimu UMEMOTO 	} else if (ifp) {
131731b3783cSHajimu UMEMOTO 		mtu = IN6_LINKMTU(ifp);
131831b3783cSHajimu UMEMOTO 	} else
131931b3783cSHajimu UMEMOTO 		error = EHOSTUNREACH; /* XXX */
132031b3783cSHajimu UMEMOTO 
132131b3783cSHajimu UMEMOTO 	*mtup = mtu;
1322f95d4633SHajimu UMEMOTO 	if (alwaysfragp)
1323f95d4633SHajimu UMEMOTO 		*alwaysfragp = alwaysfrag;
132431b3783cSHajimu UMEMOTO 	return (error);
132531b3783cSHajimu UMEMOTO }
132631b3783cSHajimu UMEMOTO 
132782cd038dSYoshinobu Inoue /*
132882cd038dSYoshinobu Inoue  * IP6 socket option processing.
132982cd038dSYoshinobu Inoue  */
133082cd038dSYoshinobu Inoue int
13311272577eSXin LI ip6_ctloutput(struct socket *so, struct sockopt *sopt)
133282cd038dSYoshinobu Inoue {
133379ba3952SBjoern A. Zeeb 	int optdatalen, uproto;
1334f95d4633SHajimu UMEMOTO 	void *optdata;
133533841545SHajimu UMEMOTO 	struct inpcb *in6p = sotoinpcb(so);
133682cd038dSYoshinobu Inoue 	int error, optval;
133782cd038dSYoshinobu Inoue 	int level, op, optname;
133882cd038dSYoshinobu Inoue 	int optlen;
1339b40ce416SJulian Elischer 	struct thread *td;
134082cd038dSYoshinobu Inoue 
134182cd038dSYoshinobu Inoue 	level = sopt->sopt_level;
134282cd038dSYoshinobu Inoue 	op = sopt->sopt_dir;
134382cd038dSYoshinobu Inoue 	optname = sopt->sopt_name;
134482cd038dSYoshinobu Inoue 	optlen = sopt->sopt_valsize;
1345b40ce416SJulian Elischer 	td = sopt->sopt_td;
1346cc29ac7dSRobert Watson 	error = 0;
1347cc29ac7dSRobert Watson 	optval = 0;
1348f95d4633SHajimu UMEMOTO 	uproto = (int)so->so_proto->pr_protocol;
134982cd038dSYoshinobu Inoue 
135082cd038dSYoshinobu Inoue 	if (level == IPPROTO_IPV6) {
135182cd038dSYoshinobu Inoue 		switch (op) {
135233841545SHajimu UMEMOTO 
135382cd038dSYoshinobu Inoue 		case SOPT_SET:
135482cd038dSYoshinobu Inoue 			switch (optname) {
1355f95d4633SHajimu UMEMOTO 			case IPV6_2292PKTOPTIONS:
1356f95d4633SHajimu UMEMOTO #ifdef IPV6_PKTOPTIONS
135782cd038dSYoshinobu Inoue 			case IPV6_PKTOPTIONS:
1358f95d4633SHajimu UMEMOTO #endif
135982cd038dSYoshinobu Inoue 			{
136082cd038dSYoshinobu Inoue 				struct mbuf *m;
136182cd038dSYoshinobu Inoue 
136282cd038dSYoshinobu Inoue 				error = soopt_getm(sopt, &m); /* XXX */
1363a89ec05eSPeter Wemm 				if (error != 0)
136482cd038dSYoshinobu Inoue 					break;
136582cd038dSYoshinobu Inoue 				error = soopt_mcopyin(sopt, m); /* XXX */
1366a89ec05eSPeter Wemm 				if (error != 0)
136782cd038dSYoshinobu Inoue 					break;
136833841545SHajimu UMEMOTO 				error = ip6_pcbopts(&in6p->in6p_outputopts,
136933841545SHajimu UMEMOTO 						    m, so, sopt);
137033841545SHajimu UMEMOTO 				m_freem(m); /* XXX */
137182cd038dSYoshinobu Inoue 				break;
137282cd038dSYoshinobu Inoue 			}
137333841545SHajimu UMEMOTO 
137433841545SHajimu UMEMOTO 			/*
137533841545SHajimu UMEMOTO 			 * Use of some Hop-by-Hop options or some
137633841545SHajimu UMEMOTO 			 * Destination options, might require special
137733841545SHajimu UMEMOTO 			 * privilege.  That is, normal applications
137833841545SHajimu UMEMOTO 			 * (without special privilege) might be forbidden
137933841545SHajimu UMEMOTO 			 * from setting certain options in outgoing packets,
138033841545SHajimu UMEMOTO 			 * and might never see certain options in received
138133841545SHajimu UMEMOTO 			 * packets. [RFC 2292 Section 6]
138233841545SHajimu UMEMOTO 			 * KAME specific note:
138333841545SHajimu UMEMOTO 			 *  KAME prevents non-privileged users from sending or
138433841545SHajimu UMEMOTO 			 *  receiving ANY hbh/dst options in order to avoid
138533841545SHajimu UMEMOTO 			 *  overhead of parsing options in the kernel.
138633841545SHajimu UMEMOTO 			 */
1387f95d4633SHajimu UMEMOTO 			case IPV6_RECVHOPOPTS:
1388f95d4633SHajimu UMEMOTO 			case IPV6_RECVDSTOPTS:
1389f95d4633SHajimu UMEMOTO 			case IPV6_RECVRTHDRDSTOPTS:
139079ba3952SBjoern A. Zeeb 				if (td != NULL) {
139179ba3952SBjoern A. Zeeb 					error = priv_check(td,
139279ba3952SBjoern A. Zeeb 					    PRIV_NETINET_SETHDROPTS);
139379ba3952SBjoern A. Zeeb 					if (error)
1394f95d4633SHajimu UMEMOTO 						break;
1395f95d4633SHajimu UMEMOTO 				}
1396f95d4633SHajimu UMEMOTO 				/* FALLTHROUGH */
139782cd038dSYoshinobu Inoue 			case IPV6_UNICAST_HOPS:
1398f95d4633SHajimu UMEMOTO 			case IPV6_HOPLIMIT:
139982cd038dSYoshinobu Inoue 			case IPV6_FAITH:
140033841545SHajimu UMEMOTO 
1401f95d4633SHajimu UMEMOTO 			case IPV6_RECVPKTINFO:
1402f95d4633SHajimu UMEMOTO 			case IPV6_RECVHOPLIMIT:
1403f95d4633SHajimu UMEMOTO 			case IPV6_RECVRTHDR:
1404f95d4633SHajimu UMEMOTO 			case IPV6_RECVPATHMTU:
1405f95d4633SHajimu UMEMOTO 			case IPV6_RECVTCLASS:
140633841545SHajimu UMEMOTO 			case IPV6_V6ONLY:
1407f95d4633SHajimu UMEMOTO 			case IPV6_AUTOFLOWLABEL:
1408f44270e7SPawel Jakub Dawidek 			case IPV6_BINDANY:
1409f44270e7SPawel Jakub Dawidek 				if (optname == IPV6_BINDANY && td != NULL) {
1410f44270e7SPawel Jakub Dawidek 					error = priv_check(td,
1411f44270e7SPawel Jakub Dawidek 					    PRIV_NETINET_BINDANY);
1412f44270e7SPawel Jakub Dawidek 					if (error)
1413f44270e7SPawel Jakub Dawidek 						break;
1414f44270e7SPawel Jakub Dawidek 				}
1415f44270e7SPawel Jakub Dawidek 
141633841545SHajimu UMEMOTO 				if (optlen != sizeof(int)) {
141782cd038dSYoshinobu Inoue 					error = EINVAL;
141833841545SHajimu UMEMOTO 					break;
141933841545SHajimu UMEMOTO 				}
142082cd038dSYoshinobu Inoue 				error = sooptcopyin(sopt, &optval,
142182cd038dSYoshinobu Inoue 					sizeof optval, sizeof optval);
142282cd038dSYoshinobu Inoue 				if (error)
142382cd038dSYoshinobu Inoue 					break;
142482cd038dSYoshinobu Inoue 				switch (optname) {
142582cd038dSYoshinobu Inoue 
142682cd038dSYoshinobu Inoue 				case IPV6_UNICAST_HOPS:
142782cd038dSYoshinobu Inoue 					if (optval < -1 || optval >= 256)
142882cd038dSYoshinobu Inoue 						error = EINVAL;
142982cd038dSYoshinobu Inoue 					else {
143082cd038dSYoshinobu Inoue 						/* -1 = kernel default */
143182cd038dSYoshinobu Inoue 						in6p->in6p_hops = optval;
1432fc384fa5SBjoern A. Zeeb 						if ((in6p->inp_vflag &
143382cd038dSYoshinobu Inoue 						     INP_IPV4) != 0)
143482cd038dSYoshinobu Inoue 							in6p->inp_ip_ttl = optval;
143582cd038dSYoshinobu Inoue 					}
143682cd038dSYoshinobu Inoue 					break;
143782cd038dSYoshinobu Inoue #define OPTSET(bit) \
143833841545SHajimu UMEMOTO do { \
143982cd038dSYoshinobu Inoue 	if (optval) \
1440fc384fa5SBjoern A. Zeeb 		in6p->inp_flags |= (bit); \
144182cd038dSYoshinobu Inoue 	else \
1442fc384fa5SBjoern A. Zeeb 		in6p->inp_flags &= ~(bit); \
14437efe5d92SHajimu UMEMOTO } while (/*CONSTCOND*/ 0)
1444f95d4633SHajimu UMEMOTO #define OPTSET2292(bit) \
1445f95d4633SHajimu UMEMOTO do { \
1446fc384fa5SBjoern A. Zeeb 	in6p->inp_flags |= IN6P_RFC2292; \
1447f95d4633SHajimu UMEMOTO 	if (optval) \
1448fc384fa5SBjoern A. Zeeb 		in6p->inp_flags |= (bit); \
1449f95d4633SHajimu UMEMOTO 	else \
1450fc384fa5SBjoern A. Zeeb 		in6p->inp_flags &= ~(bit); \
1451f95d4633SHajimu UMEMOTO } while (/*CONSTCOND*/ 0)
1452fc384fa5SBjoern A. Zeeb #define OPTBIT(bit) (in6p->inp_flags & (bit) ? 1 : 0)
145382cd038dSYoshinobu Inoue 
1454f95d4633SHajimu UMEMOTO 				case IPV6_RECVPKTINFO:
1455f95d4633SHajimu UMEMOTO 					/* cannot mix with RFC2292 */
1456f95d4633SHajimu UMEMOTO 					if (OPTBIT(IN6P_RFC2292)) {
1457f95d4633SHajimu UMEMOTO 						error = EINVAL;
1458f95d4633SHajimu UMEMOTO 						break;
1459f95d4633SHajimu UMEMOTO 					}
1460f95d4633SHajimu UMEMOTO 					OPTSET(IN6P_PKTINFO);
1461f95d4633SHajimu UMEMOTO 					break;
1462f95d4633SHajimu UMEMOTO 
1463f95d4633SHajimu UMEMOTO 				case IPV6_HOPLIMIT:
1464f95d4633SHajimu UMEMOTO 				{
1465f95d4633SHajimu UMEMOTO 					struct ip6_pktopts **optp;
1466f95d4633SHajimu UMEMOTO 
1467f95d4633SHajimu UMEMOTO 					/* cannot mix with RFC2292 */
1468f95d4633SHajimu UMEMOTO 					if (OPTBIT(IN6P_RFC2292)) {
1469f95d4633SHajimu UMEMOTO 						error = EINVAL;
1470f95d4633SHajimu UMEMOTO 						break;
1471f95d4633SHajimu UMEMOTO 					}
1472f95d4633SHajimu UMEMOTO 					optp = &in6p->in6p_outputopts;
1473f95d4633SHajimu UMEMOTO 					error = ip6_pcbopt(IPV6_HOPLIMIT,
147479ba3952SBjoern A. Zeeb 					    (u_char *)&optval, sizeof(optval),
147579ba3952SBjoern A. Zeeb 					    optp, (td != NULL) ? td->td_ucred :
147679ba3952SBjoern A. Zeeb 					    NULL, uproto);
1477f95d4633SHajimu UMEMOTO 					break;
1478f95d4633SHajimu UMEMOTO 				}
1479f95d4633SHajimu UMEMOTO 
1480f95d4633SHajimu UMEMOTO 				case IPV6_RECVHOPLIMIT:
1481f95d4633SHajimu UMEMOTO 					/* cannot mix with RFC2292 */
1482f95d4633SHajimu UMEMOTO 					if (OPTBIT(IN6P_RFC2292)) {
1483f95d4633SHajimu UMEMOTO 						error = EINVAL;
1484f95d4633SHajimu UMEMOTO 						break;
1485f95d4633SHajimu UMEMOTO 					}
1486f95d4633SHajimu UMEMOTO 					OPTSET(IN6P_HOPLIMIT);
1487f95d4633SHajimu UMEMOTO 					break;
1488f95d4633SHajimu UMEMOTO 
1489f95d4633SHajimu UMEMOTO 				case IPV6_RECVHOPOPTS:
1490f95d4633SHajimu UMEMOTO 					/* cannot mix with RFC2292 */
1491f95d4633SHajimu UMEMOTO 					if (OPTBIT(IN6P_RFC2292)) {
1492f95d4633SHajimu UMEMOTO 						error = EINVAL;
1493f95d4633SHajimu UMEMOTO 						break;
1494f95d4633SHajimu UMEMOTO 					}
1495f95d4633SHajimu UMEMOTO 					OPTSET(IN6P_HOPOPTS);
1496f95d4633SHajimu UMEMOTO 					break;
1497f95d4633SHajimu UMEMOTO 
1498f95d4633SHajimu UMEMOTO 				case IPV6_RECVDSTOPTS:
1499f95d4633SHajimu UMEMOTO 					/* cannot mix with RFC2292 */
1500f95d4633SHajimu UMEMOTO 					if (OPTBIT(IN6P_RFC2292)) {
1501f95d4633SHajimu UMEMOTO 						error = EINVAL;
1502f95d4633SHajimu UMEMOTO 						break;
1503f95d4633SHajimu UMEMOTO 					}
1504f95d4633SHajimu UMEMOTO 					OPTSET(IN6P_DSTOPTS);
1505f95d4633SHajimu UMEMOTO 					break;
1506f95d4633SHajimu UMEMOTO 
1507f95d4633SHajimu UMEMOTO 				case IPV6_RECVRTHDRDSTOPTS:
1508f95d4633SHajimu UMEMOTO 					/* cannot mix with RFC2292 */
1509f95d4633SHajimu UMEMOTO 					if (OPTBIT(IN6P_RFC2292)) {
1510f95d4633SHajimu UMEMOTO 						error = EINVAL;
1511f95d4633SHajimu UMEMOTO 						break;
1512f95d4633SHajimu UMEMOTO 					}
1513f95d4633SHajimu UMEMOTO 					OPTSET(IN6P_RTHDRDSTOPTS);
1514f95d4633SHajimu UMEMOTO 					break;
1515f95d4633SHajimu UMEMOTO 
1516f95d4633SHajimu UMEMOTO 				case IPV6_RECVRTHDR:
1517f95d4633SHajimu UMEMOTO 					/* cannot mix with RFC2292 */
1518f95d4633SHajimu UMEMOTO 					if (OPTBIT(IN6P_RFC2292)) {
1519f95d4633SHajimu UMEMOTO 						error = EINVAL;
1520f95d4633SHajimu UMEMOTO 						break;
1521f95d4633SHajimu UMEMOTO 					}
1522f95d4633SHajimu UMEMOTO 					OPTSET(IN6P_RTHDR);
152382cd038dSYoshinobu Inoue 					break;
152482cd038dSYoshinobu Inoue 
152582cd038dSYoshinobu Inoue 				case IPV6_FAITH:
152697590249SBjoern A. Zeeb 					OPTSET(INP_FAITH);
152782cd038dSYoshinobu Inoue 					break;
152882cd038dSYoshinobu Inoue 
1529f95d4633SHajimu UMEMOTO 				case IPV6_RECVPATHMTU:
1530f95d4633SHajimu UMEMOTO 					/*
1531f95d4633SHajimu UMEMOTO 					 * We ignore this option for TCP
1532f95d4633SHajimu UMEMOTO 					 * sockets.
153318b35df8SHajimu UMEMOTO 					 * (RFC3542 leaves this case
1534f95d4633SHajimu UMEMOTO 					 * unspecified.)
1535f95d4633SHajimu UMEMOTO 					 */
1536f95d4633SHajimu UMEMOTO 					if (uproto != IPPROTO_TCP)
1537f95d4633SHajimu UMEMOTO 						OPTSET(IN6P_MTU);
1538f95d4633SHajimu UMEMOTO 					break;
1539f95d4633SHajimu UMEMOTO 
154033841545SHajimu UMEMOTO 				case IPV6_V6ONLY:
154133841545SHajimu UMEMOTO 					/*
15420554093bSHajimu UMEMOTO 					 * make setsockopt(IPV6_V6ONLY)
15430554093bSHajimu UMEMOTO 					 * available only prior to bind(2).
15440554093bSHajimu UMEMOTO 					 * see ipng mailing list, Jun 22 2001.
15450554093bSHajimu UMEMOTO 					 */
1546fc384fa5SBjoern A. Zeeb 					if (in6p->inp_lport ||
15477efe5d92SHajimu UMEMOTO 					    !IN6_IS_ADDR_UNSPECIFIED(&in6p->in6p_laddr)) {
15480554093bSHajimu UMEMOTO 						error = EINVAL;
15490554093bSHajimu UMEMOTO 						break;
15500554093bSHajimu UMEMOTO 					}
155133841545SHajimu UMEMOTO 					OPTSET(IN6P_IPV6_V6ONLY);
155212253795SHajimu UMEMOTO 					if (optval)
1553fc384fa5SBjoern A. Zeeb 						in6p->inp_vflag &= ~INP_IPV4;
155412253795SHajimu UMEMOTO 					else
1555fc384fa5SBjoern A. Zeeb 						in6p->inp_vflag |= INP_IPV4;
155682cd038dSYoshinobu Inoue 					break;
1557f95d4633SHajimu UMEMOTO 				case IPV6_RECVTCLASS:
1558f95d4633SHajimu UMEMOTO 					/* cannot mix with RFC2292 XXX */
1559f95d4633SHajimu UMEMOTO 					if (OPTBIT(IN6P_RFC2292)) {
1560f95d4633SHajimu UMEMOTO 						error = EINVAL;
1561f95d4633SHajimu UMEMOTO 						break;
1562f95d4633SHajimu UMEMOTO 					}
1563f95d4633SHajimu UMEMOTO 					OPTSET(IN6P_TCLASS);
1564f95d4633SHajimu UMEMOTO 					break;
1565f95d4633SHajimu UMEMOTO 				case IPV6_AUTOFLOWLABEL:
1566f95d4633SHajimu UMEMOTO 					OPTSET(IN6P_AUTOFLOWLABEL);
1567f95d4633SHajimu UMEMOTO 					break;
1568f95d4633SHajimu UMEMOTO 
1569f44270e7SPawel Jakub Dawidek 				case IPV6_BINDANY:
1570f44270e7SPawel Jakub Dawidek 					OPTSET(INP_BINDANY);
1571f44270e7SPawel Jakub Dawidek 					break;
157282cd038dSYoshinobu Inoue 				}
157333841545SHajimu UMEMOTO 				break;
157433841545SHajimu UMEMOTO 
1575f95d4633SHajimu UMEMOTO 			case IPV6_TCLASS:
1576f95d4633SHajimu UMEMOTO 			case IPV6_DONTFRAG:
1577f95d4633SHajimu UMEMOTO 			case IPV6_USE_MIN_MTU:
1578f95d4633SHajimu UMEMOTO 			case IPV6_PREFER_TEMPADDR:
1579f95d4633SHajimu UMEMOTO 				if (optlen != sizeof(optval)) {
1580f95d4633SHajimu UMEMOTO 					error = EINVAL;
1581f95d4633SHajimu UMEMOTO 					break;
1582f95d4633SHajimu UMEMOTO 				}
1583f95d4633SHajimu UMEMOTO 				error = sooptcopyin(sopt, &optval,
1584f95d4633SHajimu UMEMOTO 					sizeof optval, sizeof optval);
1585f95d4633SHajimu UMEMOTO 				if (error)
1586f95d4633SHajimu UMEMOTO 					break;
1587f95d4633SHajimu UMEMOTO 				{
1588f95d4633SHajimu UMEMOTO 					struct ip6_pktopts **optp;
1589f95d4633SHajimu UMEMOTO 					optp = &in6p->in6p_outputopts;
1590f95d4633SHajimu UMEMOTO 					error = ip6_pcbopt(optname,
159179ba3952SBjoern A. Zeeb 					    (u_char *)&optval, sizeof(optval),
159279ba3952SBjoern A. Zeeb 					    optp, (td != NULL) ? td->td_ucred :
159379ba3952SBjoern A. Zeeb 					    NULL, uproto);
1594f95d4633SHajimu UMEMOTO 					break;
1595f95d4633SHajimu UMEMOTO 				}
1596f95d4633SHajimu UMEMOTO 
1597f95d4633SHajimu UMEMOTO 			case IPV6_2292PKTINFO:
1598f95d4633SHajimu UMEMOTO 			case IPV6_2292HOPLIMIT:
1599f95d4633SHajimu UMEMOTO 			case IPV6_2292HOPOPTS:
1600f95d4633SHajimu UMEMOTO 			case IPV6_2292DSTOPTS:
1601f95d4633SHajimu UMEMOTO 			case IPV6_2292RTHDR:
160233841545SHajimu UMEMOTO 				/* RFC 2292 */
160333841545SHajimu UMEMOTO 				if (optlen != sizeof(int)) {
160433841545SHajimu UMEMOTO 					error = EINVAL;
160533841545SHajimu UMEMOTO 					break;
160633841545SHajimu UMEMOTO 				}
160733841545SHajimu UMEMOTO 				error = sooptcopyin(sopt, &optval,
160833841545SHajimu UMEMOTO 					sizeof optval, sizeof optval);
160933841545SHajimu UMEMOTO 				if (error)
161033841545SHajimu UMEMOTO 					break;
161133841545SHajimu UMEMOTO 				switch (optname) {
1612f95d4633SHajimu UMEMOTO 				case IPV6_2292PKTINFO:
1613f95d4633SHajimu UMEMOTO 					OPTSET2292(IN6P_PKTINFO);
161433841545SHajimu UMEMOTO 					break;
1615f95d4633SHajimu UMEMOTO 				case IPV6_2292HOPLIMIT:
1616f95d4633SHajimu UMEMOTO 					OPTSET2292(IN6P_HOPLIMIT);
161733841545SHajimu UMEMOTO 					break;
1618f95d4633SHajimu UMEMOTO 				case IPV6_2292HOPOPTS:
161933841545SHajimu UMEMOTO 					/*
162033841545SHajimu UMEMOTO 					 * Check super-user privilege.
162133841545SHajimu UMEMOTO 					 * See comments for IPV6_RECVHOPOPTS.
162233841545SHajimu UMEMOTO 					 */
162379ba3952SBjoern A. Zeeb 					if (td != NULL) {
162479ba3952SBjoern A. Zeeb 						error = priv_check(td,
162579ba3952SBjoern A. Zeeb 						    PRIV_NETINET_SETHDROPTS);
162679ba3952SBjoern A. Zeeb 						if (error)
162779ba3952SBjoern A. Zeeb 							return (error);
162879ba3952SBjoern A. Zeeb 					}
1629f95d4633SHajimu UMEMOTO 					OPTSET2292(IN6P_HOPOPTS);
163033841545SHajimu UMEMOTO 					break;
1631f95d4633SHajimu UMEMOTO 				case IPV6_2292DSTOPTS:
163279ba3952SBjoern A. Zeeb 					if (td != NULL) {
163379ba3952SBjoern A. Zeeb 						error = priv_check(td,
163479ba3952SBjoern A. Zeeb 						    PRIV_NETINET_SETHDROPTS);
163579ba3952SBjoern A. Zeeb 						if (error)
163679ba3952SBjoern A. Zeeb 							return (error);
163779ba3952SBjoern A. Zeeb 					}
1638f95d4633SHajimu UMEMOTO 					OPTSET2292(IN6P_DSTOPTS|IN6P_RTHDRDSTOPTS); /* XXX */
163933841545SHajimu UMEMOTO 					break;
1640f95d4633SHajimu UMEMOTO 				case IPV6_2292RTHDR:
1641f95d4633SHajimu UMEMOTO 					OPTSET2292(IN6P_RTHDR);
164233841545SHajimu UMEMOTO 					break;
164382cd038dSYoshinobu Inoue 				}
164482cd038dSYoshinobu Inoue 				break;
1645f95d4633SHajimu UMEMOTO 			case IPV6_PKTINFO:
1646f95d4633SHajimu UMEMOTO 			case IPV6_HOPOPTS:
1647f95d4633SHajimu UMEMOTO 			case IPV6_RTHDR:
1648f95d4633SHajimu UMEMOTO 			case IPV6_DSTOPTS:
1649f95d4633SHajimu UMEMOTO 			case IPV6_RTHDRDSTOPTS:
1650f95d4633SHajimu UMEMOTO 			case IPV6_NEXTHOP:
1651f95d4633SHajimu UMEMOTO 			{
165218b35df8SHajimu UMEMOTO 				/* new advanced API (RFC3542) */
1653f95d4633SHajimu UMEMOTO 				u_char *optbuf;
1654e770771aSHajimu UMEMOTO 				u_char optbuf_storage[MCLBYTES];
1655f95d4633SHajimu UMEMOTO 				int optlen;
1656f95d4633SHajimu UMEMOTO 				struct ip6_pktopts **optp;
1657f95d4633SHajimu UMEMOTO 
1658f95d4633SHajimu UMEMOTO 				/* cannot mix with RFC2292 */
1659f95d4633SHajimu UMEMOTO 				if (OPTBIT(IN6P_RFC2292)) {
1660f95d4633SHajimu UMEMOTO 					error = EINVAL;
1661f95d4633SHajimu UMEMOTO 					break;
1662f95d4633SHajimu UMEMOTO 				}
1663f95d4633SHajimu UMEMOTO 
1664e770771aSHajimu UMEMOTO 				/*
1665e770771aSHajimu UMEMOTO 				 * We only ensure valsize is not too large
1666e770771aSHajimu UMEMOTO 				 * here.  Further validation will be done
1667e770771aSHajimu UMEMOTO 				 * later.
1668e770771aSHajimu UMEMOTO 				 */
1669e770771aSHajimu UMEMOTO 				error = sooptcopyin(sopt, optbuf_storage,
1670e770771aSHajimu UMEMOTO 				    sizeof(optbuf_storage), 0);
1671a5d1aae3SHajimu UMEMOTO 				if (error)
1672a5d1aae3SHajimu UMEMOTO 					break;
1673f95d4633SHajimu UMEMOTO 				optlen = sopt->sopt_valsize;
1674e770771aSHajimu UMEMOTO 				optbuf = optbuf_storage;
1675f95d4633SHajimu UMEMOTO 				optp = &in6p->in6p_outputopts;
167679ba3952SBjoern A. Zeeb 				error = ip6_pcbopt(optname, optbuf, optlen,
167779ba3952SBjoern A. Zeeb 				    optp, (td != NULL) ? td->td_ucred : NULL,
167879ba3952SBjoern A. Zeeb 				    uproto);
1679f95d4633SHajimu UMEMOTO 				break;
1680f95d4633SHajimu UMEMOTO 			}
168182cd038dSYoshinobu Inoue #undef OPTSET
168282cd038dSYoshinobu Inoue 
168382cd038dSYoshinobu Inoue 			case IPV6_MULTICAST_IF:
168482cd038dSYoshinobu Inoue 			case IPV6_MULTICAST_HOPS:
168582cd038dSYoshinobu Inoue 			case IPV6_MULTICAST_LOOP:
168682cd038dSYoshinobu Inoue 			case IPV6_JOIN_GROUP:
168782cd038dSYoshinobu Inoue 			case IPV6_LEAVE_GROUP:
168833cde130SBruce M Simpson 			case IPV6_MSFILTER:
168933cde130SBruce M Simpson 			case MCAST_BLOCK_SOURCE:
169033cde130SBruce M Simpson 			case MCAST_UNBLOCK_SOURCE:
169133cde130SBruce M Simpson 			case MCAST_JOIN_GROUP:
169233cde130SBruce M Simpson 			case MCAST_LEAVE_GROUP:
169333cde130SBruce M Simpson 			case MCAST_JOIN_SOURCE_GROUP:
169433cde130SBruce M Simpson 			case MCAST_LEAVE_SOURCE_GROUP:
169533cde130SBruce M Simpson 				error = ip6_setmoptions(in6p, sopt);
169682cd038dSYoshinobu Inoue 				break;
169782cd038dSYoshinobu Inoue 
169882cd038dSYoshinobu Inoue 			case IPV6_PORTRANGE:
1699686cdd19SJun-ichiro itojun Hagino 				error = sooptcopyin(sopt, &optval,
1700686cdd19SJun-ichiro itojun Hagino 				    sizeof optval, sizeof optval);
170182cd038dSYoshinobu Inoue 				if (error)
170282cd038dSYoshinobu Inoue 					break;
170382cd038dSYoshinobu Inoue 
170482cd038dSYoshinobu Inoue 				switch (optval) {
170582cd038dSYoshinobu Inoue 				case IPV6_PORTRANGE_DEFAULT:
170697590249SBjoern A. Zeeb 					in6p->inp_flags &= ~(INP_LOWPORT);
170797590249SBjoern A. Zeeb 					in6p->inp_flags &= ~(INP_HIGHPORT);
170882cd038dSYoshinobu Inoue 					break;
170982cd038dSYoshinobu Inoue 
171082cd038dSYoshinobu Inoue 				case IPV6_PORTRANGE_HIGH:
171197590249SBjoern A. Zeeb 					in6p->inp_flags &= ~(INP_LOWPORT);
171297590249SBjoern A. Zeeb 					in6p->inp_flags |= INP_HIGHPORT;
171382cd038dSYoshinobu Inoue 					break;
171482cd038dSYoshinobu Inoue 
171582cd038dSYoshinobu Inoue 				case IPV6_PORTRANGE_LOW:
171697590249SBjoern A. Zeeb 					in6p->inp_flags &= ~(INP_HIGHPORT);
171797590249SBjoern A. Zeeb 					in6p->inp_flags |= INP_LOWPORT;
171882cd038dSYoshinobu Inoue 					break;
171982cd038dSYoshinobu Inoue 
172082cd038dSYoshinobu Inoue 				default:
172182cd038dSYoshinobu Inoue 					error = EINVAL;
172282cd038dSYoshinobu Inoue 					break;
172382cd038dSYoshinobu Inoue 				}
172482cd038dSYoshinobu Inoue 				break;
172582cd038dSYoshinobu Inoue 
1726b2630c29SGeorge V. Neville-Neil #ifdef IPSEC
172782cd038dSYoshinobu Inoue 			case IPV6_IPSEC_POLICY:
172882cd038dSYoshinobu Inoue 			{
1729c26fe973SBjoern A. Zeeb 				caddr_t req;
173082cd038dSYoshinobu Inoue 				struct mbuf *m;
173182cd038dSYoshinobu Inoue 
1732686cdd19SJun-ichiro itojun Hagino 				if ((error = soopt_getm(sopt, &m)) != 0) /* XXX */
173382cd038dSYoshinobu Inoue 					break;
1734686cdd19SJun-ichiro itojun Hagino 				if ((error = soopt_mcopyin(sopt, m)) != 0) /* XXX */
173582cd038dSYoshinobu Inoue 					break;
173682cd038dSYoshinobu Inoue 				req = mtod(m, caddr_t);
173797aa4a51SBjoern A. Zeeb 				error = ipsec_set_policy(in6p, optname, req,
1738c26fe973SBjoern A. Zeeb 				    m->m_len, (sopt->sopt_td != NULL) ?
1739c26fe973SBjoern A. Zeeb 				    sopt->sopt_td->td_ucred : NULL);
174082cd038dSYoshinobu Inoue 				m_freem(m);
174182cd038dSYoshinobu Inoue 				break;
1742c26fe973SBjoern A. Zeeb 			}
1743b2630c29SGeorge V. Neville-Neil #endif /* IPSEC */
174482cd038dSYoshinobu Inoue 
174582cd038dSYoshinobu Inoue 			default:
174682cd038dSYoshinobu Inoue 				error = ENOPROTOOPT;
174782cd038dSYoshinobu Inoue 				break;
174882cd038dSYoshinobu Inoue 			}
174982cd038dSYoshinobu Inoue 			break;
175082cd038dSYoshinobu Inoue 
175182cd038dSYoshinobu Inoue 		case SOPT_GET:
175282cd038dSYoshinobu Inoue 			switch (optname) {
175382cd038dSYoshinobu Inoue 
1754f95d4633SHajimu UMEMOTO 			case IPV6_2292PKTOPTIONS:
1755f95d4633SHajimu UMEMOTO #ifdef IPV6_PKTOPTIONS
175682cd038dSYoshinobu Inoue 			case IPV6_PKTOPTIONS:
1757f95d4633SHajimu UMEMOTO #endif
1758f95d4633SHajimu UMEMOTO 				/*
1759f95d4633SHajimu UMEMOTO 				 * RFC3542 (effectively) deprecated the
1760f95d4633SHajimu UMEMOTO 				 * semantics of the 2292-style pktoptions.
1761f95d4633SHajimu UMEMOTO 				 * Since it was not reliable in nature (i.e.,
1762f95d4633SHajimu UMEMOTO 				 * applications had to expect the lack of some
1763f95d4633SHajimu UMEMOTO 				 * information after all), it would make sense
1764f95d4633SHajimu UMEMOTO 				 * to simplify this part by always returning
1765f95d4633SHajimu UMEMOTO 				 * empty data.
1766f95d4633SHajimu UMEMOTO 				 */
176782cd038dSYoshinobu Inoue 				sopt->sopt_valsize = 0;
176882cd038dSYoshinobu Inoue 				break;
176982cd038dSYoshinobu Inoue 
1770f95d4633SHajimu UMEMOTO 			case IPV6_RECVHOPOPTS:
1771f95d4633SHajimu UMEMOTO 			case IPV6_RECVDSTOPTS:
1772f95d4633SHajimu UMEMOTO 			case IPV6_RECVRTHDRDSTOPTS:
177382cd038dSYoshinobu Inoue 			case IPV6_UNICAST_HOPS:
1774f95d4633SHajimu UMEMOTO 			case IPV6_RECVPKTINFO:
1775f95d4633SHajimu UMEMOTO 			case IPV6_RECVHOPLIMIT:
1776f95d4633SHajimu UMEMOTO 			case IPV6_RECVRTHDR:
1777f95d4633SHajimu UMEMOTO 			case IPV6_RECVPATHMTU:
177833841545SHajimu UMEMOTO 
177982cd038dSYoshinobu Inoue 			case IPV6_FAITH:
178033841545SHajimu UMEMOTO 			case IPV6_V6ONLY:
1781fa310a7eSYoshinobu Inoue 			case IPV6_PORTRANGE:
1782f95d4633SHajimu UMEMOTO 			case IPV6_RECVTCLASS:
1783f95d4633SHajimu UMEMOTO 			case IPV6_AUTOFLOWLABEL:
178482cd038dSYoshinobu Inoue 				switch (optname) {
178582cd038dSYoshinobu Inoue 
1786f95d4633SHajimu UMEMOTO 				case IPV6_RECVHOPOPTS:
1787f95d4633SHajimu UMEMOTO 					optval = OPTBIT(IN6P_HOPOPTS);
1788f95d4633SHajimu UMEMOTO 					break;
1789f95d4633SHajimu UMEMOTO 
1790f95d4633SHajimu UMEMOTO 				case IPV6_RECVDSTOPTS:
1791f95d4633SHajimu UMEMOTO 					optval = OPTBIT(IN6P_DSTOPTS);
1792f95d4633SHajimu UMEMOTO 					break;
1793f95d4633SHajimu UMEMOTO 
1794f95d4633SHajimu UMEMOTO 				case IPV6_RECVRTHDRDSTOPTS:
1795f95d4633SHajimu UMEMOTO 					optval = OPTBIT(IN6P_RTHDRDSTOPTS);
1796f95d4633SHajimu UMEMOTO 					break;
1797f95d4633SHajimu UMEMOTO 
179882cd038dSYoshinobu Inoue 				case IPV6_UNICAST_HOPS:
179982cd038dSYoshinobu Inoue 					optval = in6p->in6p_hops;
180082cd038dSYoshinobu Inoue 					break;
180182cd038dSYoshinobu Inoue 
1802f95d4633SHajimu UMEMOTO 				case IPV6_RECVPKTINFO:
1803f95d4633SHajimu UMEMOTO 					optval = OPTBIT(IN6P_PKTINFO);
1804f95d4633SHajimu UMEMOTO 					break;
1805f95d4633SHajimu UMEMOTO 
1806f95d4633SHajimu UMEMOTO 				case IPV6_RECVHOPLIMIT:
1807f95d4633SHajimu UMEMOTO 					optval = OPTBIT(IN6P_HOPLIMIT);
1808f95d4633SHajimu UMEMOTO 					break;
1809f95d4633SHajimu UMEMOTO 
1810f95d4633SHajimu UMEMOTO 				case IPV6_RECVRTHDR:
1811f95d4633SHajimu UMEMOTO 					optval = OPTBIT(IN6P_RTHDR);
1812f95d4633SHajimu UMEMOTO 					break;
1813f95d4633SHajimu UMEMOTO 
1814f95d4633SHajimu UMEMOTO 				case IPV6_RECVPATHMTU:
1815f95d4633SHajimu UMEMOTO 					optval = OPTBIT(IN6P_MTU);
181682cd038dSYoshinobu Inoue 					break;
181782cd038dSYoshinobu Inoue 
181882cd038dSYoshinobu Inoue 				case IPV6_FAITH:
181997590249SBjoern A. Zeeb 					optval = OPTBIT(INP_FAITH);
182082cd038dSYoshinobu Inoue 					break;
182182cd038dSYoshinobu Inoue 
182233841545SHajimu UMEMOTO 				case IPV6_V6ONLY:
1823854d3b19SHajimu UMEMOTO 					optval = OPTBIT(IN6P_IPV6_V6ONLY);
182482cd038dSYoshinobu Inoue 					break;
182582cd038dSYoshinobu Inoue 
182682cd038dSYoshinobu Inoue 				case IPV6_PORTRANGE:
182782cd038dSYoshinobu Inoue 				    {
182882cd038dSYoshinobu Inoue 					int flags;
1829fc384fa5SBjoern A. Zeeb 					flags = in6p->inp_flags;
183097590249SBjoern A. Zeeb 					if (flags & INP_HIGHPORT)
183182cd038dSYoshinobu Inoue 						optval = IPV6_PORTRANGE_HIGH;
183297590249SBjoern A. Zeeb 					else if (flags & INP_LOWPORT)
183382cd038dSYoshinobu Inoue 						optval = IPV6_PORTRANGE_LOW;
183482cd038dSYoshinobu Inoue 					else
183582cd038dSYoshinobu Inoue 						optval = 0;
183682cd038dSYoshinobu Inoue 					break;
183782cd038dSYoshinobu Inoue 				    }
1838f95d4633SHajimu UMEMOTO 				case IPV6_RECVTCLASS:
1839f95d4633SHajimu UMEMOTO 					optval = OPTBIT(IN6P_TCLASS);
1840f95d4633SHajimu UMEMOTO 					break;
1841f95d4633SHajimu UMEMOTO 
1842f95d4633SHajimu UMEMOTO 				case IPV6_AUTOFLOWLABEL:
1843f95d4633SHajimu UMEMOTO 					optval = OPTBIT(IN6P_AUTOFLOWLABEL);
1844f95d4633SHajimu UMEMOTO 					break;
1845f44270e7SPawel Jakub Dawidek 
1846f44270e7SPawel Jakub Dawidek 				case IPV6_BINDANY:
1847f44270e7SPawel Jakub Dawidek 					optval = OPTBIT(INP_BINDANY);
1848f44270e7SPawel Jakub Dawidek 					break;
184982cd038dSYoshinobu Inoue 				}
1850f95d4633SHajimu UMEMOTO 				if (error)
1851f95d4633SHajimu UMEMOTO 					break;
185282cd038dSYoshinobu Inoue 				error = sooptcopyout(sopt, &optval,
185382cd038dSYoshinobu Inoue 					sizeof optval);
185482cd038dSYoshinobu Inoue 				break;
185582cd038dSYoshinobu Inoue 
1856f95d4633SHajimu UMEMOTO 			case IPV6_PATHMTU:
1857f95d4633SHajimu UMEMOTO 			{
1858f95d4633SHajimu UMEMOTO 				u_long pmtu = 0;
1859f95d4633SHajimu UMEMOTO 				struct ip6_mtuinfo mtuinfo;
186097d8d152SAndre Oppermann 				struct route_in6 sro;
186197d8d152SAndre Oppermann 
186297d8d152SAndre Oppermann 				bzero(&sro, sizeof(sro));
1863f95d4633SHajimu UMEMOTO 
1864f95d4633SHajimu UMEMOTO 				if (!(so->so_state & SS_ISCONNECTED))
1865f95d4633SHajimu UMEMOTO 					return (ENOTCONN);
1866f95d4633SHajimu UMEMOTO 				/*
1867f95d4633SHajimu UMEMOTO 				 * XXX: we dot not consider the case of source
1868f95d4633SHajimu UMEMOTO 				 * routing, or optional information to specify
1869f95d4633SHajimu UMEMOTO 				 * the outgoing interface.
1870f95d4633SHajimu UMEMOTO 				 */
187197d8d152SAndre Oppermann 				error = ip6_getpmtu(&sro, NULL, NULL,
1872f95d4633SHajimu UMEMOTO 				    &in6p->in6p_faddr, &pmtu, NULL);
187397d8d152SAndre Oppermann 				if (sro.ro_rt)
187497d8d152SAndre Oppermann 					RTFREE(sro.ro_rt);
1875f95d4633SHajimu UMEMOTO 				if (error)
1876f95d4633SHajimu UMEMOTO 					break;
1877f95d4633SHajimu UMEMOTO 				if (pmtu > IPV6_MAXPACKET)
1878f95d4633SHajimu UMEMOTO 					pmtu = IPV6_MAXPACKET;
1879f95d4633SHajimu UMEMOTO 
1880f95d4633SHajimu UMEMOTO 				bzero(&mtuinfo, sizeof(mtuinfo));
1881f95d4633SHajimu UMEMOTO 				mtuinfo.ip6m_mtu = (u_int32_t)pmtu;
1882f95d4633SHajimu UMEMOTO 				optdata = (void *)&mtuinfo;
1883f95d4633SHajimu UMEMOTO 				optdatalen = sizeof(mtuinfo);
1884f95d4633SHajimu UMEMOTO 				error = sooptcopyout(sopt, optdata,
1885f95d4633SHajimu UMEMOTO 				    optdatalen);
1886f95d4633SHajimu UMEMOTO 				break;
1887f95d4633SHajimu UMEMOTO 			}
1888f95d4633SHajimu UMEMOTO 
1889f95d4633SHajimu UMEMOTO 			case IPV6_2292PKTINFO:
1890f95d4633SHajimu UMEMOTO 			case IPV6_2292HOPLIMIT:
1891f95d4633SHajimu UMEMOTO 			case IPV6_2292HOPOPTS:
1892f95d4633SHajimu UMEMOTO 			case IPV6_2292RTHDR:
1893f95d4633SHajimu UMEMOTO 			case IPV6_2292DSTOPTS:
189433841545SHajimu UMEMOTO 				switch (optname) {
1895f95d4633SHajimu UMEMOTO 				case IPV6_2292PKTINFO:
189633841545SHajimu UMEMOTO 					optval = OPTBIT(IN6P_PKTINFO);
189733841545SHajimu UMEMOTO 					break;
1898f95d4633SHajimu UMEMOTO 				case IPV6_2292HOPLIMIT:
189933841545SHajimu UMEMOTO 					optval = OPTBIT(IN6P_HOPLIMIT);
190033841545SHajimu UMEMOTO 					break;
1901f95d4633SHajimu UMEMOTO 				case IPV6_2292HOPOPTS:
190233841545SHajimu UMEMOTO 					optval = OPTBIT(IN6P_HOPOPTS);
190333841545SHajimu UMEMOTO 					break;
1904f95d4633SHajimu UMEMOTO 				case IPV6_2292RTHDR:
190533841545SHajimu UMEMOTO 					optval = OPTBIT(IN6P_RTHDR);
190633841545SHajimu UMEMOTO 					break;
1907f95d4633SHajimu UMEMOTO 				case IPV6_2292DSTOPTS:
190833841545SHajimu UMEMOTO 					optval = OPTBIT(IN6P_DSTOPTS|IN6P_RTHDRDSTOPTS);
190933841545SHajimu UMEMOTO 					break;
191033841545SHajimu UMEMOTO 				}
191133841545SHajimu UMEMOTO 				error = sooptcopyout(sopt, &optval,
191233841545SHajimu UMEMOTO 				    sizeof optval);
191333841545SHajimu UMEMOTO 				break;
1914f95d4633SHajimu UMEMOTO 			case IPV6_PKTINFO:
1915f95d4633SHajimu UMEMOTO 			case IPV6_HOPOPTS:
1916f95d4633SHajimu UMEMOTO 			case IPV6_RTHDR:
1917f95d4633SHajimu UMEMOTO 			case IPV6_DSTOPTS:
1918f95d4633SHajimu UMEMOTO 			case IPV6_RTHDRDSTOPTS:
1919f95d4633SHajimu UMEMOTO 			case IPV6_NEXTHOP:
1920f95d4633SHajimu UMEMOTO 			case IPV6_TCLASS:
1921f95d4633SHajimu UMEMOTO 			case IPV6_DONTFRAG:
1922f95d4633SHajimu UMEMOTO 			case IPV6_USE_MIN_MTU:
1923f95d4633SHajimu UMEMOTO 			case IPV6_PREFER_TEMPADDR:
1924f95d4633SHajimu UMEMOTO 				error = ip6_getpcbopt(in6p->in6p_outputopts,
1925f95d4633SHajimu UMEMOTO 				    optname, sopt);
1926f95d4633SHajimu UMEMOTO 				break;
192733841545SHajimu UMEMOTO 
192882cd038dSYoshinobu Inoue 			case IPV6_MULTICAST_IF:
192982cd038dSYoshinobu Inoue 			case IPV6_MULTICAST_HOPS:
193082cd038dSYoshinobu Inoue 			case IPV6_MULTICAST_LOOP:
193133cde130SBruce M Simpson 			case IPV6_MSFILTER:
193233cde130SBruce M Simpson 				error = ip6_getmoptions(in6p, sopt);
193382cd038dSYoshinobu Inoue 				break;
193482cd038dSYoshinobu Inoue 
1935b2630c29SGeorge V. Neville-Neil #ifdef IPSEC
193682cd038dSYoshinobu Inoue 			case IPV6_IPSEC_POLICY:
193782cd038dSYoshinobu Inoue 			  {
1938f63e7634SYoshinobu Inoue 				caddr_t req = NULL;
1939686cdd19SJun-ichiro itojun Hagino 				size_t len = 0;
1940686cdd19SJun-ichiro itojun Hagino 				struct mbuf *m = NULL;
1941686cdd19SJun-ichiro itojun Hagino 				struct mbuf **mp = &m;
1942f95d4633SHajimu UMEMOTO 				size_t ovalsize = sopt->sopt_valsize;
1943f95d4633SHajimu UMEMOTO 				caddr_t oval = (caddr_t)sopt->sopt_val;
1944f63e7634SYoshinobu Inoue 
1945686cdd19SJun-ichiro itojun Hagino 				error = soopt_getm(sopt, &m); /* XXX */
1946a46f7e7cSHajimu UMEMOTO 				if (error != 0)
1947686cdd19SJun-ichiro itojun Hagino 					break;
1948686cdd19SJun-ichiro itojun Hagino 				error = soopt_mcopyin(sopt, m); /* XXX */
1949a46f7e7cSHajimu UMEMOTO 				if (error != 0)
1950686cdd19SJun-ichiro itojun Hagino 					break;
1951f95d4633SHajimu UMEMOTO 				sopt->sopt_valsize = ovalsize;
1952f95d4633SHajimu UMEMOTO 				sopt->sopt_val = oval;
1953686cdd19SJun-ichiro itojun Hagino 				if (m) {
195482cd038dSYoshinobu Inoue 					req = mtod(m, caddr_t);
1955686cdd19SJun-ichiro itojun Hagino 					len = m->m_len;
1956686cdd19SJun-ichiro itojun Hagino 				}
195797aa4a51SBjoern A. Zeeb 				error = ipsec_get_policy(in6p, req, len, mp);
195882cd038dSYoshinobu Inoue 				if (error == 0)
195982cd038dSYoshinobu Inoue 					error = soopt_mcopyout(sopt, m); /* XXX */
196033841545SHajimu UMEMOTO 				if (error == 0 && m)
196182cd038dSYoshinobu Inoue 					m_freem(m);
196282cd038dSYoshinobu Inoue 				break;
196382cd038dSYoshinobu Inoue 			  }
1964b2630c29SGeorge V. Neville-Neil #endif /* IPSEC */
196582cd038dSYoshinobu Inoue 
196682cd038dSYoshinobu Inoue 			default:
196782cd038dSYoshinobu Inoue 				error = ENOPROTOOPT;
196882cd038dSYoshinobu Inoue 				break;
196982cd038dSYoshinobu Inoue 			}
197082cd038dSYoshinobu Inoue 			break;
197182cd038dSYoshinobu Inoue 		}
1972f95d4633SHajimu UMEMOTO 	} else {		/* level != IPPROTO_IPV6 */
197382cd038dSYoshinobu Inoue 		error = EINVAL;
197482cd038dSYoshinobu Inoue 	}
197582cd038dSYoshinobu Inoue 	return (error);
197682cd038dSYoshinobu Inoue }
197782cd038dSYoshinobu Inoue 
197802b9a206SHajimu UMEMOTO int
19791272577eSXin LI ip6_raw_ctloutput(struct socket *so, struct sockopt *sopt)
198002b9a206SHajimu UMEMOTO {
198102b9a206SHajimu UMEMOTO 	int error = 0, optval, optlen;
198202b9a206SHajimu UMEMOTO 	const int icmp6off = offsetof(struct icmp6_hdr, icmp6_cksum);
1983fc384fa5SBjoern A. Zeeb 	struct inpcb *in6p = sotoinpcb(so);
198402b9a206SHajimu UMEMOTO 	int level, op, optname;
198502b9a206SHajimu UMEMOTO 
198602b9a206SHajimu UMEMOTO 	level = sopt->sopt_level;
198702b9a206SHajimu UMEMOTO 	op = sopt->sopt_dir;
198802b9a206SHajimu UMEMOTO 	optname = sopt->sopt_name;
198902b9a206SHajimu UMEMOTO 	optlen = sopt->sopt_valsize;
199002b9a206SHajimu UMEMOTO 
199102b9a206SHajimu UMEMOTO 	if (level != IPPROTO_IPV6) {
199202b9a206SHajimu UMEMOTO 		return (EINVAL);
199302b9a206SHajimu UMEMOTO 	}
199402b9a206SHajimu UMEMOTO 
199502b9a206SHajimu UMEMOTO 	switch (optname) {
199602b9a206SHajimu UMEMOTO 	case IPV6_CHECKSUM:
199702b9a206SHajimu UMEMOTO 		/*
199802b9a206SHajimu UMEMOTO 		 * For ICMPv6 sockets, no modification allowed for checksum
199902b9a206SHajimu UMEMOTO 		 * offset, permit "no change" values to help existing apps.
200002b9a206SHajimu UMEMOTO 		 *
200118b35df8SHajimu UMEMOTO 		 * RFC3542 says: "An attempt to set IPV6_CHECKSUM
200202b9a206SHajimu UMEMOTO 		 * for an ICMPv6 socket will fail."
200318b35df8SHajimu UMEMOTO 		 * The current behavior does not meet RFC3542.
200402b9a206SHajimu UMEMOTO 		 */
200502b9a206SHajimu UMEMOTO 		switch (op) {
200602b9a206SHajimu UMEMOTO 		case SOPT_SET:
200702b9a206SHajimu UMEMOTO 			if (optlen != sizeof(int)) {
200802b9a206SHajimu UMEMOTO 				error = EINVAL;
200902b9a206SHajimu UMEMOTO 				break;
201002b9a206SHajimu UMEMOTO 			}
201102b9a206SHajimu UMEMOTO 			error = sooptcopyin(sopt, &optval, sizeof(optval),
201202b9a206SHajimu UMEMOTO 					    sizeof(optval));
201302b9a206SHajimu UMEMOTO 			if (error)
201402b9a206SHajimu UMEMOTO 				break;
201502b9a206SHajimu UMEMOTO 			if ((optval % 2) != 0) {
201602b9a206SHajimu UMEMOTO 				/* the API assumes even offset values */
201702b9a206SHajimu UMEMOTO 				error = EINVAL;
201802b9a206SHajimu UMEMOTO 			} else if (so->so_proto->pr_protocol ==
201902b9a206SHajimu UMEMOTO 			    IPPROTO_ICMPV6) {
202002b9a206SHajimu UMEMOTO 				if (optval != icmp6off)
202102b9a206SHajimu UMEMOTO 					error = EINVAL;
202202b9a206SHajimu UMEMOTO 			} else
202302b9a206SHajimu UMEMOTO 				in6p->in6p_cksum = optval;
202402b9a206SHajimu UMEMOTO 			break;
202502b9a206SHajimu UMEMOTO 
202602b9a206SHajimu UMEMOTO 		case SOPT_GET:
202702b9a206SHajimu UMEMOTO 			if (so->so_proto->pr_protocol == IPPROTO_ICMPV6)
202802b9a206SHajimu UMEMOTO 				optval = icmp6off;
202902b9a206SHajimu UMEMOTO 			else
203002b9a206SHajimu UMEMOTO 				optval = in6p->in6p_cksum;
203102b9a206SHajimu UMEMOTO 
203202b9a206SHajimu UMEMOTO 			error = sooptcopyout(sopt, &optval, sizeof(optval));
203302b9a206SHajimu UMEMOTO 			break;
203402b9a206SHajimu UMEMOTO 
203502b9a206SHajimu UMEMOTO 		default:
203602b9a206SHajimu UMEMOTO 			error = EINVAL;
203702b9a206SHajimu UMEMOTO 			break;
203802b9a206SHajimu UMEMOTO 		}
203902b9a206SHajimu UMEMOTO 		break;
204002b9a206SHajimu UMEMOTO 
204102b9a206SHajimu UMEMOTO 	default:
204202b9a206SHajimu UMEMOTO 		error = ENOPROTOOPT;
204302b9a206SHajimu UMEMOTO 		break;
204402b9a206SHajimu UMEMOTO 	}
204502b9a206SHajimu UMEMOTO 
204602b9a206SHajimu UMEMOTO 	return (error);
204702b9a206SHajimu UMEMOTO }
204802b9a206SHajimu UMEMOTO 
204982cd038dSYoshinobu Inoue /*
205033841545SHajimu UMEMOTO  * Set up IP6 options in pcb for insertion in output packets or
205133841545SHajimu UMEMOTO  * specifying behavior of outgoing packets.
205282cd038dSYoshinobu Inoue  */
205382cd038dSYoshinobu Inoue static int
20541272577eSXin LI ip6_pcbopts(struct ip6_pktopts **pktopt, struct mbuf *m,
20551272577eSXin LI     struct socket *so, struct sockopt *sopt)
205682cd038dSYoshinobu Inoue {
205733841545SHajimu UMEMOTO 	struct ip6_pktopts *opt = *pktopt;
205882cd038dSYoshinobu Inoue 	int error = 0;
2059b40ce416SJulian Elischer 	struct thread *td = sopt->sopt_td;
206082cd038dSYoshinobu Inoue 
206182cd038dSYoshinobu Inoue 	/* turn off any old options. */
206282cd038dSYoshinobu Inoue 	if (opt) {
206333841545SHajimu UMEMOTO #ifdef DIAGNOSTIC
206433841545SHajimu UMEMOTO 		if (opt->ip6po_pktinfo || opt->ip6po_nexthop ||
206533841545SHajimu UMEMOTO 		    opt->ip6po_hbh || opt->ip6po_dest1 || opt->ip6po_dest2 ||
206633841545SHajimu UMEMOTO 		    opt->ip6po_rhinfo.ip6po_rhi_rthdr)
206733841545SHajimu UMEMOTO 			printf("ip6_pcbopts: all specified options are cleared.\n");
206833841545SHajimu UMEMOTO #endif
2069f95d4633SHajimu UMEMOTO 		ip6_clearpktopts(opt, -1);
207082cd038dSYoshinobu Inoue 	} else
2071a163d034SWarner Losh 		opt = malloc(sizeof(*opt), M_IP6OPT, M_WAITOK);
207233841545SHajimu UMEMOTO 	*pktopt = NULL;
207382cd038dSYoshinobu Inoue 
207482cd038dSYoshinobu Inoue 	if (!m || m->m_len == 0) {
207582cd038dSYoshinobu Inoue 		/*
207635f6695bSHajimu UMEMOTO 		 * Only turning off any previous options, regardless of
207735f6695bSHajimu UMEMOTO 		 * whether the opt is just created or given.
207882cd038dSYoshinobu Inoue 		 */
207982cd038dSYoshinobu Inoue 		free(opt, M_IP6OPT);
208082cd038dSYoshinobu Inoue 		return (0);
208182cd038dSYoshinobu Inoue 	}
208282cd038dSYoshinobu Inoue 
208382cd038dSYoshinobu Inoue 	/*  set options specified by user. */
208479ba3952SBjoern A. Zeeb 	if ((error = ip6_setpktopts(m, opt, NULL, (td != NULL) ?
208579ba3952SBjoern A. Zeeb 	    td->td_ucred : NULL, so->so_proto->pr_protocol)) != 0) {
2086f95d4633SHajimu UMEMOTO 		ip6_clearpktopts(opt, -1); /* XXX: discard all options */
208735f6695bSHajimu UMEMOTO 		free(opt, M_IP6OPT);
208882cd038dSYoshinobu Inoue 		return (error);
208982cd038dSYoshinobu Inoue 	}
209082cd038dSYoshinobu Inoue 	*pktopt = opt;
209182cd038dSYoshinobu Inoue 	return (0);
209282cd038dSYoshinobu Inoue }
209382cd038dSYoshinobu Inoue 
209482cd038dSYoshinobu Inoue /*
209533841545SHajimu UMEMOTO  * initialize ip6_pktopts.  beware that there are non-zero default values in
209633841545SHajimu UMEMOTO  * the struct.
209733841545SHajimu UMEMOTO  */
209833841545SHajimu UMEMOTO void
20991272577eSXin LI ip6_initpktopts(struct ip6_pktopts *opt)
210033841545SHajimu UMEMOTO {
210133841545SHajimu UMEMOTO 
210233841545SHajimu UMEMOTO 	bzero(opt, sizeof(*opt));
210333841545SHajimu UMEMOTO 	opt->ip6po_hlim = -1;	/* -1 means default hop limit */
2104f95d4633SHajimu UMEMOTO 	opt->ip6po_tclass = -1;	/* -1 means default traffic class */
2105f95d4633SHajimu UMEMOTO 	opt->ip6po_minmtu = IP6PO_MINMTU_MCASTONLY;
2106f95d4633SHajimu UMEMOTO 	opt->ip6po_prefer_tempaddr = IP6PO_TEMPADDR_SYSTEM;
2107f95d4633SHajimu UMEMOTO }
2108f95d4633SHajimu UMEMOTO 
2109f95d4633SHajimu UMEMOTO static int
21101272577eSXin LI ip6_pcbopt(int optname, u_char *buf, int len, struct ip6_pktopts **pktopt,
211179ba3952SBjoern A. Zeeb     struct ucred *cred, int uproto)
2112f95d4633SHajimu UMEMOTO {
2113f95d4633SHajimu UMEMOTO 	struct ip6_pktopts *opt;
2114f95d4633SHajimu UMEMOTO 
2115f95d4633SHajimu UMEMOTO 	if (*pktopt == NULL) {
2116f95d4633SHajimu UMEMOTO 		*pktopt = malloc(sizeof(struct ip6_pktopts), M_IP6OPT,
2117f95d4633SHajimu UMEMOTO 		    M_WAITOK);
2118d5e3406dSHajimu UMEMOTO 		ip6_initpktopts(*pktopt);
2119f95d4633SHajimu UMEMOTO 	}
2120f95d4633SHajimu UMEMOTO 	opt = *pktopt;
2121f95d4633SHajimu UMEMOTO 
212279ba3952SBjoern A. Zeeb 	return (ip6_setpktopt(optname, buf, len, opt, cred, 1, 0, uproto));
2123f95d4633SHajimu UMEMOTO }
2124f95d4633SHajimu UMEMOTO 
2125f95d4633SHajimu UMEMOTO static int
21261272577eSXin LI ip6_getpcbopt(struct ip6_pktopts *pktopt, int optname, struct sockopt *sopt)
2127f95d4633SHajimu UMEMOTO {
2128f95d4633SHajimu UMEMOTO 	void *optdata = NULL;
2129f95d4633SHajimu UMEMOTO 	int optdatalen = 0;
2130f95d4633SHajimu UMEMOTO 	struct ip6_ext *ip6e;
2131f95d4633SHajimu UMEMOTO 	int error = 0;
2132f95d4633SHajimu UMEMOTO 	struct in6_pktinfo null_pktinfo;
2133f95d4633SHajimu UMEMOTO 	int deftclass = 0, on;
2134f95d4633SHajimu UMEMOTO 	int defminmtu = IP6PO_MINMTU_MCASTONLY;
2135f95d4633SHajimu UMEMOTO 	int defpreftemp = IP6PO_TEMPADDR_SYSTEM;
2136f95d4633SHajimu UMEMOTO 
2137f95d4633SHajimu UMEMOTO 	switch (optname) {
2138f95d4633SHajimu UMEMOTO 	case IPV6_PKTINFO:
2139f95d4633SHajimu UMEMOTO 		if (pktopt && pktopt->ip6po_pktinfo)
2140f95d4633SHajimu UMEMOTO 			optdata = (void *)pktopt->ip6po_pktinfo;
2141f95d4633SHajimu UMEMOTO 		else {
2142f95d4633SHajimu UMEMOTO 			/* XXX: we don't have to do this every time... */
2143f95d4633SHajimu UMEMOTO 			bzero(&null_pktinfo, sizeof(null_pktinfo));
2144f95d4633SHajimu UMEMOTO 			optdata = (void *)&null_pktinfo;
2145f95d4633SHajimu UMEMOTO 		}
2146f95d4633SHajimu UMEMOTO 		optdatalen = sizeof(struct in6_pktinfo);
2147f95d4633SHajimu UMEMOTO 		break;
2148f95d4633SHajimu UMEMOTO 	case IPV6_TCLASS:
2149f95d4633SHajimu UMEMOTO 		if (pktopt && pktopt->ip6po_tclass >= 0)
2150f95d4633SHajimu UMEMOTO 			optdata = (void *)&pktopt->ip6po_tclass;
2151f95d4633SHajimu UMEMOTO 		else
2152f95d4633SHajimu UMEMOTO 			optdata = (void *)&deftclass;
2153f95d4633SHajimu UMEMOTO 		optdatalen = sizeof(int);
2154f95d4633SHajimu UMEMOTO 		break;
2155f95d4633SHajimu UMEMOTO 	case IPV6_HOPOPTS:
2156f95d4633SHajimu UMEMOTO 		if (pktopt && pktopt->ip6po_hbh) {
2157f95d4633SHajimu UMEMOTO 			optdata = (void *)pktopt->ip6po_hbh;
2158f95d4633SHajimu UMEMOTO 			ip6e = (struct ip6_ext *)pktopt->ip6po_hbh;
2159f95d4633SHajimu UMEMOTO 			optdatalen = (ip6e->ip6e_len + 1) << 3;
2160f95d4633SHajimu UMEMOTO 		}
2161f95d4633SHajimu UMEMOTO 		break;
2162f95d4633SHajimu UMEMOTO 	case IPV6_RTHDR:
2163f95d4633SHajimu UMEMOTO 		if (pktopt && pktopt->ip6po_rthdr) {
2164f95d4633SHajimu UMEMOTO 			optdata = (void *)pktopt->ip6po_rthdr;
2165f95d4633SHajimu UMEMOTO 			ip6e = (struct ip6_ext *)pktopt->ip6po_rthdr;
2166f95d4633SHajimu UMEMOTO 			optdatalen = (ip6e->ip6e_len + 1) << 3;
2167f95d4633SHajimu UMEMOTO 		}
2168f95d4633SHajimu UMEMOTO 		break;
2169f95d4633SHajimu UMEMOTO 	case IPV6_RTHDRDSTOPTS:
2170f95d4633SHajimu UMEMOTO 		if (pktopt && pktopt->ip6po_dest1) {
2171f95d4633SHajimu UMEMOTO 			optdata = (void *)pktopt->ip6po_dest1;
2172f95d4633SHajimu UMEMOTO 			ip6e = (struct ip6_ext *)pktopt->ip6po_dest1;
2173f95d4633SHajimu UMEMOTO 			optdatalen = (ip6e->ip6e_len + 1) << 3;
2174f95d4633SHajimu UMEMOTO 		}
2175f95d4633SHajimu UMEMOTO 		break;
2176f95d4633SHajimu UMEMOTO 	case IPV6_DSTOPTS:
2177f95d4633SHajimu UMEMOTO 		if (pktopt && pktopt->ip6po_dest2) {
2178f95d4633SHajimu UMEMOTO 			optdata = (void *)pktopt->ip6po_dest2;
2179f95d4633SHajimu UMEMOTO 			ip6e = (struct ip6_ext *)pktopt->ip6po_dest2;
2180f95d4633SHajimu UMEMOTO 			optdatalen = (ip6e->ip6e_len + 1) << 3;
2181f95d4633SHajimu UMEMOTO 		}
2182f95d4633SHajimu UMEMOTO 		break;
2183f95d4633SHajimu UMEMOTO 	case IPV6_NEXTHOP:
2184f95d4633SHajimu UMEMOTO 		if (pktopt && pktopt->ip6po_nexthop) {
2185f95d4633SHajimu UMEMOTO 			optdata = (void *)pktopt->ip6po_nexthop;
2186f95d4633SHajimu UMEMOTO 			optdatalen = pktopt->ip6po_nexthop->sa_len;
2187f95d4633SHajimu UMEMOTO 		}
2188f95d4633SHajimu UMEMOTO 		break;
2189f95d4633SHajimu UMEMOTO 	case IPV6_USE_MIN_MTU:
2190f95d4633SHajimu UMEMOTO 		if (pktopt)
2191f95d4633SHajimu UMEMOTO 			optdata = (void *)&pktopt->ip6po_minmtu;
2192f95d4633SHajimu UMEMOTO 		else
2193f95d4633SHajimu UMEMOTO 			optdata = (void *)&defminmtu;
2194f95d4633SHajimu UMEMOTO 		optdatalen = sizeof(int);
2195f95d4633SHajimu UMEMOTO 		break;
2196f95d4633SHajimu UMEMOTO 	case IPV6_DONTFRAG:
2197f95d4633SHajimu UMEMOTO 		if (pktopt && ((pktopt->ip6po_flags) & IP6PO_DONTFRAG))
2198f95d4633SHajimu UMEMOTO 			on = 1;
2199f95d4633SHajimu UMEMOTO 		else
2200f95d4633SHajimu UMEMOTO 			on = 0;
2201f95d4633SHajimu UMEMOTO 		optdata = (void *)&on;
2202f95d4633SHajimu UMEMOTO 		optdatalen = sizeof(on);
2203f95d4633SHajimu UMEMOTO 		break;
2204f95d4633SHajimu UMEMOTO 	case IPV6_PREFER_TEMPADDR:
2205f95d4633SHajimu UMEMOTO 		if (pktopt)
2206f95d4633SHajimu UMEMOTO 			optdata = (void *)&pktopt->ip6po_prefer_tempaddr;
2207f95d4633SHajimu UMEMOTO 		else
2208f95d4633SHajimu UMEMOTO 			optdata = (void *)&defpreftemp;
2209f95d4633SHajimu UMEMOTO 		optdatalen = sizeof(int);
2210f95d4633SHajimu UMEMOTO 		break;
2211f95d4633SHajimu UMEMOTO 	default:		/* should not happen */
2212f95d4633SHajimu UMEMOTO #ifdef DIAGNOSTIC
2213f95d4633SHajimu UMEMOTO 		panic("ip6_getpcbopt: unexpected option\n");
2214f95d4633SHajimu UMEMOTO #endif
2215f95d4633SHajimu UMEMOTO 		return (ENOPROTOOPT);
2216f95d4633SHajimu UMEMOTO 	}
2217f95d4633SHajimu UMEMOTO 
2218f95d4633SHajimu UMEMOTO 	error = sooptcopyout(sopt, optdata, optdatalen);
2219f95d4633SHajimu UMEMOTO 
2220f95d4633SHajimu UMEMOTO 	return (error);
222133841545SHajimu UMEMOTO }
222233841545SHajimu UMEMOTO 
222333841545SHajimu UMEMOTO void
22241272577eSXin LI ip6_clearpktopts(struct ip6_pktopts *pktopt, int optname)
222533841545SHajimu UMEMOTO {
2226289b28bdSHajimu UMEMOTO 	if (pktopt == NULL)
2227289b28bdSHajimu UMEMOTO 		return;
2228289b28bdSHajimu UMEMOTO 
2229f95d4633SHajimu UMEMOTO 	if (optname == -1 || optname == IPV6_PKTINFO) {
2230885adbfaSHajimu UMEMOTO 		if (pktopt->ip6po_pktinfo)
223133841545SHajimu UMEMOTO 			free(pktopt->ip6po_pktinfo, M_IP6OPT);
223233841545SHajimu UMEMOTO 		pktopt->ip6po_pktinfo = NULL;
223333841545SHajimu UMEMOTO 	}
2234f95d4633SHajimu UMEMOTO 	if (optname == -1 || optname == IPV6_HOPLIMIT)
223533841545SHajimu UMEMOTO 		pktopt->ip6po_hlim = -1;
2236f95d4633SHajimu UMEMOTO 	if (optname == -1 || optname == IPV6_TCLASS)
2237f95d4633SHajimu UMEMOTO 		pktopt->ip6po_tclass = -1;
2238f95d4633SHajimu UMEMOTO 	if (optname == -1 || optname == IPV6_NEXTHOP) {
2239f95d4633SHajimu UMEMOTO 		if (pktopt->ip6po_nextroute.ro_rt) {
2240f95d4633SHajimu UMEMOTO 			RTFREE(pktopt->ip6po_nextroute.ro_rt);
2241f95d4633SHajimu UMEMOTO 			pktopt->ip6po_nextroute.ro_rt = NULL;
2242f95d4633SHajimu UMEMOTO 		}
2243885adbfaSHajimu UMEMOTO 		if (pktopt->ip6po_nexthop)
224433841545SHajimu UMEMOTO 			free(pktopt->ip6po_nexthop, M_IP6OPT);
224533841545SHajimu UMEMOTO 		pktopt->ip6po_nexthop = NULL;
224633841545SHajimu UMEMOTO 	}
2247f95d4633SHajimu UMEMOTO 	if (optname == -1 || optname == IPV6_HOPOPTS) {
2248885adbfaSHajimu UMEMOTO 		if (pktopt->ip6po_hbh)
224933841545SHajimu UMEMOTO 			free(pktopt->ip6po_hbh, M_IP6OPT);
225033841545SHajimu UMEMOTO 		pktopt->ip6po_hbh = NULL;
225133841545SHajimu UMEMOTO 	}
2252f95d4633SHajimu UMEMOTO 	if (optname == -1 || optname == IPV6_RTHDRDSTOPTS) {
2253885adbfaSHajimu UMEMOTO 		if (pktopt->ip6po_dest1)
225433841545SHajimu UMEMOTO 			free(pktopt->ip6po_dest1, M_IP6OPT);
225533841545SHajimu UMEMOTO 		pktopt->ip6po_dest1 = NULL;
225633841545SHajimu UMEMOTO 	}
2257f95d4633SHajimu UMEMOTO 	if (optname == -1 || optname == IPV6_RTHDR) {
2258885adbfaSHajimu UMEMOTO 		if (pktopt->ip6po_rhinfo.ip6po_rhi_rthdr)
225933841545SHajimu UMEMOTO 			free(pktopt->ip6po_rhinfo.ip6po_rhi_rthdr, M_IP6OPT);
226033841545SHajimu UMEMOTO 		pktopt->ip6po_rhinfo.ip6po_rhi_rthdr = NULL;
226133841545SHajimu UMEMOTO 		if (pktopt->ip6po_route.ro_rt) {
226233841545SHajimu UMEMOTO 			RTFREE(pktopt->ip6po_route.ro_rt);
226333841545SHajimu UMEMOTO 			pktopt->ip6po_route.ro_rt = NULL;
226433841545SHajimu UMEMOTO 		}
226533841545SHajimu UMEMOTO 	}
2266f95d4633SHajimu UMEMOTO 	if (optname == -1 || optname == IPV6_DSTOPTS) {
2267885adbfaSHajimu UMEMOTO 		if (pktopt->ip6po_dest2)
226833841545SHajimu UMEMOTO 			free(pktopt->ip6po_dest2, M_IP6OPT);
226933841545SHajimu UMEMOTO 		pktopt->ip6po_dest2 = NULL;
227033841545SHajimu UMEMOTO 	}
227133841545SHajimu UMEMOTO }
227233841545SHajimu UMEMOTO 
227333841545SHajimu UMEMOTO #define PKTOPT_EXTHDRCPY(type) \
227433841545SHajimu UMEMOTO do {\
227533841545SHajimu UMEMOTO 	if (src->type) {\
22767efe5d92SHajimu UMEMOTO 		int hlen = (((struct ip6_ext *)src->type)->ip6e_len + 1) << 3;\
227733841545SHajimu UMEMOTO 		dst->type = malloc(hlen, M_IP6OPT, canwait);\
227833841545SHajimu UMEMOTO 		if (dst->type == NULL && canwait == M_NOWAIT)\
227933841545SHajimu UMEMOTO 			goto bad;\
228033841545SHajimu UMEMOTO 		bcopy(src->type, dst->type, hlen);\
228133841545SHajimu UMEMOTO 	}\
22827efe5d92SHajimu UMEMOTO } while (/*CONSTCOND*/ 0)
228333841545SHajimu UMEMOTO 
2284885adbfaSHajimu UMEMOTO static int
22851272577eSXin LI copypktopts(struct ip6_pktopts *dst, struct ip6_pktopts *src, int canwait)
228633841545SHajimu UMEMOTO {
2287885adbfaSHajimu UMEMOTO 	if (dst == NULL || src == NULL)  {
228833841545SHajimu UMEMOTO 		printf("ip6_clearpktopts: invalid argument\n");
2289885adbfaSHajimu UMEMOTO 		return (EINVAL);
229033841545SHajimu UMEMOTO 	}
229133841545SHajimu UMEMOTO 
229233841545SHajimu UMEMOTO 	dst->ip6po_hlim = src->ip6po_hlim;
2293f95d4633SHajimu UMEMOTO 	dst->ip6po_tclass = src->ip6po_tclass;
2294f95d4633SHajimu UMEMOTO 	dst->ip6po_flags = src->ip6po_flags;
229533841545SHajimu UMEMOTO 	if (src->ip6po_pktinfo) {
229633841545SHajimu UMEMOTO 		dst->ip6po_pktinfo = malloc(sizeof(*dst->ip6po_pktinfo),
229733841545SHajimu UMEMOTO 		    M_IP6OPT, canwait);
22982cb64cb2SGeorge V. Neville-Neil 		if (dst->ip6po_pktinfo == NULL)
229933841545SHajimu UMEMOTO 			goto bad;
230033841545SHajimu UMEMOTO 		*dst->ip6po_pktinfo = *src->ip6po_pktinfo;
230133841545SHajimu UMEMOTO 	}
230233841545SHajimu UMEMOTO 	if (src->ip6po_nexthop) {
230333841545SHajimu UMEMOTO 		dst->ip6po_nexthop = malloc(src->ip6po_nexthop->sa_len,
230433841545SHajimu UMEMOTO 		    M_IP6OPT, canwait);
2305403cbcf5SGeorge V. Neville-Neil 		if (dst->ip6po_nexthop == NULL)
230633841545SHajimu UMEMOTO 			goto bad;
230733841545SHajimu UMEMOTO 		bcopy(src->ip6po_nexthop, dst->ip6po_nexthop,
230833841545SHajimu UMEMOTO 		    src->ip6po_nexthop->sa_len);
230933841545SHajimu UMEMOTO 	}
231033841545SHajimu UMEMOTO 	PKTOPT_EXTHDRCPY(ip6po_hbh);
231133841545SHajimu UMEMOTO 	PKTOPT_EXTHDRCPY(ip6po_dest1);
231233841545SHajimu UMEMOTO 	PKTOPT_EXTHDRCPY(ip6po_dest2);
231333841545SHajimu UMEMOTO 	PKTOPT_EXTHDRCPY(ip6po_rthdr); /* not copy the cached route */
2314885adbfaSHajimu UMEMOTO 	return (0);
231533841545SHajimu UMEMOTO 
231633841545SHajimu UMEMOTO   bad:
2317016fb9d9SMike Makonnen 	ip6_clearpktopts(dst, -1);
2318885adbfaSHajimu UMEMOTO 	return (ENOBUFS);
2319885adbfaSHajimu UMEMOTO }
2320885adbfaSHajimu UMEMOTO #undef PKTOPT_EXTHDRCPY
2321885adbfaSHajimu UMEMOTO 
2322885adbfaSHajimu UMEMOTO struct ip6_pktopts *
23231272577eSXin LI ip6_copypktopts(struct ip6_pktopts *src, int canwait)
2324885adbfaSHajimu UMEMOTO {
2325885adbfaSHajimu UMEMOTO 	int error;
2326885adbfaSHajimu UMEMOTO 	struct ip6_pktopts *dst;
2327885adbfaSHajimu UMEMOTO 
2328885adbfaSHajimu UMEMOTO 	dst = malloc(sizeof(*dst), M_IP6OPT, canwait);
23292cb64cb2SGeorge V. Neville-Neil 	if (dst == NULL)
2330885adbfaSHajimu UMEMOTO 		return (NULL);
2331885adbfaSHajimu UMEMOTO 	ip6_initpktopts(dst);
2332885adbfaSHajimu UMEMOTO 
2333885adbfaSHajimu UMEMOTO 	if ((error = copypktopts(dst, src, canwait)) != 0) {
233435f6695bSHajimu UMEMOTO 		free(dst, M_IP6OPT);
233533841545SHajimu UMEMOTO 		return (NULL);
233633841545SHajimu UMEMOTO 	}
2337885adbfaSHajimu UMEMOTO 
2338885adbfaSHajimu UMEMOTO 	return (dst);
2339885adbfaSHajimu UMEMOTO }
234033841545SHajimu UMEMOTO 
234133841545SHajimu UMEMOTO void
23421272577eSXin LI ip6_freepcbopts(struct ip6_pktopts *pktopt)
234333841545SHajimu UMEMOTO {
234433841545SHajimu UMEMOTO 	if (pktopt == NULL)
234533841545SHajimu UMEMOTO 		return;
234633841545SHajimu UMEMOTO 
2347f95d4633SHajimu UMEMOTO 	ip6_clearpktopts(pktopt, -1);
234833841545SHajimu UMEMOTO 
234933841545SHajimu UMEMOTO 	free(pktopt, M_IP6OPT);
235033841545SHajimu UMEMOTO }
235133841545SHajimu UMEMOTO 
235233841545SHajimu UMEMOTO /*
235382cd038dSYoshinobu Inoue  * Set IPv6 outgoing packet options based on advanced API.
235482cd038dSYoshinobu Inoue  */
235582cd038dSYoshinobu Inoue int
23561272577eSXin LI ip6_setpktopts(struct mbuf *control, struct ip6_pktopts *opt,
235779ba3952SBjoern A. Zeeb     struct ip6_pktopts *stickyopt, struct ucred *cred, int uproto)
235882cd038dSYoshinobu Inoue {
235933841545SHajimu UMEMOTO 	struct cmsghdr *cm = 0;
236082cd038dSYoshinobu Inoue 
23618507acb1SHajimu UMEMOTO 	if (control == NULL || opt == NULL)
236282cd038dSYoshinobu Inoue 		return (EINVAL);
236382cd038dSYoshinobu Inoue 
2364885adbfaSHajimu UMEMOTO 	ip6_initpktopts(opt);
2365f95d4633SHajimu UMEMOTO 	if (stickyopt) {
2366885adbfaSHajimu UMEMOTO 		int error;
2367885adbfaSHajimu UMEMOTO 
2368f95d4633SHajimu UMEMOTO 		/*
2369f95d4633SHajimu UMEMOTO 		 * If stickyopt is provided, make a local copy of the options
2370f95d4633SHajimu UMEMOTO 		 * for this particular packet, then override them by ancillary
2371f95d4633SHajimu UMEMOTO 		 * objects.
2372885adbfaSHajimu UMEMOTO 		 * XXX: copypktopts() does not copy the cached route to a next
2373885adbfaSHajimu UMEMOTO 		 * hop (if any).  This is not very good in terms of efficiency,
2374885adbfaSHajimu UMEMOTO 		 * but we can allow this since this option should be rarely
2375885adbfaSHajimu UMEMOTO 		 * used.
2376f95d4633SHajimu UMEMOTO 		 */
2377885adbfaSHajimu UMEMOTO 		if ((error = copypktopts(opt, stickyopt, M_NOWAIT)) != 0)
2378885adbfaSHajimu UMEMOTO 			return (error);
2379f95d4633SHajimu UMEMOTO 	}
238082cd038dSYoshinobu Inoue 
238182cd038dSYoshinobu Inoue 	/*
238282cd038dSYoshinobu Inoue 	 * XXX: Currently, we assume all the optional information is stored
238382cd038dSYoshinobu Inoue 	 * in a single mbuf.
238482cd038dSYoshinobu Inoue 	 */
238582cd038dSYoshinobu Inoue 	if (control->m_next)
238682cd038dSYoshinobu Inoue 		return (EINVAL);
238782cd038dSYoshinobu Inoue 
23886f4da201SBjoern A. Zeeb 	for (; control->m_len > 0; control->m_data += CMSG_ALIGN(cm->cmsg_len),
238933841545SHajimu UMEMOTO 	    control->m_len -= CMSG_ALIGN(cm->cmsg_len)) {
2390f95d4633SHajimu UMEMOTO 		int error;
2391f95d4633SHajimu UMEMOTO 
2392f95d4633SHajimu UMEMOTO 		if (control->m_len < CMSG_LEN(0))
2393f95d4633SHajimu UMEMOTO 			return (EINVAL);
2394f95d4633SHajimu UMEMOTO 
239582cd038dSYoshinobu Inoue 		cm = mtod(control, struct cmsghdr *);
239682cd038dSYoshinobu Inoue 		if (cm->cmsg_len == 0 || cm->cmsg_len > control->m_len)
239782cd038dSYoshinobu Inoue 			return (EINVAL);
239882cd038dSYoshinobu Inoue 		if (cm->cmsg_level != IPPROTO_IPV6)
239982cd038dSYoshinobu Inoue 			continue;
240082cd038dSYoshinobu Inoue 
2401d5e3406dSHajimu UMEMOTO 		error = ip6_setpktopt(cm->cmsg_type, CMSG_DATA(cm),
240279ba3952SBjoern A. Zeeb 		    cm->cmsg_len - CMSG_LEN(0), opt, cred, 0, 1, uproto);
2403f95d4633SHajimu UMEMOTO 		if (error)
2404f95d4633SHajimu UMEMOTO 			return (error);
2405f95d4633SHajimu UMEMOTO 	}
240682cd038dSYoshinobu Inoue 
2407f95d4633SHajimu UMEMOTO 	return (0);
2408f95d4633SHajimu UMEMOTO }
2409f95d4633SHajimu UMEMOTO 
2410f95d4633SHajimu UMEMOTO /*
2411f95d4633SHajimu UMEMOTO  * Set a particular packet option, as a sticky option or an ancillary data
2412f95d4633SHajimu UMEMOTO  * item.  "len" can be 0 only when it's a sticky option.
2413f95d4633SHajimu UMEMOTO  * We have 4 cases of combination of "sticky" and "cmsg":
2414f95d4633SHajimu UMEMOTO  * "sticky=0, cmsg=0": impossible
241518b35df8SHajimu UMEMOTO  * "sticky=0, cmsg=1": RFC2292 or RFC3542 ancillary data
241618b35df8SHajimu UMEMOTO  * "sticky=1, cmsg=0": RFC3542 socket option
2417f95d4633SHajimu UMEMOTO  * "sticky=1, cmsg=1": RFC2292 socket option
2418f95d4633SHajimu UMEMOTO  */
2419f95d4633SHajimu UMEMOTO static int
24201272577eSXin LI ip6_setpktopt(int optname, u_char *buf, int len, struct ip6_pktopts *opt,
242179ba3952SBjoern A. Zeeb     struct ucred *cred, int sticky, int cmsg, int uproto)
2422f95d4633SHajimu UMEMOTO {
24238b615593SMarko Zec 	INIT_VNET_NET(curvnet);
24248b615593SMarko Zec 	INIT_VNET_INET6(curvnet);
2425f95d4633SHajimu UMEMOTO 	int minmtupolicy, preftemp;
242679ba3952SBjoern A. Zeeb 	int error;
2427f95d4633SHajimu UMEMOTO 
2428f95d4633SHajimu UMEMOTO 	if (!sticky && !cmsg) {
2429f95d4633SHajimu UMEMOTO #ifdef DIAGNOSTIC
2430d5e3406dSHajimu UMEMOTO 		printf("ip6_setpktopt: impossible case\n");
2431f95d4633SHajimu UMEMOTO #endif
2432f95d4633SHajimu UMEMOTO 		return (EINVAL);
2433f95d4633SHajimu UMEMOTO 	}
2434f95d4633SHajimu UMEMOTO 
2435f95d4633SHajimu UMEMOTO 	/*
2436f95d4633SHajimu UMEMOTO 	 * IPV6_2292xxx is for backward compatibility to RFC2292, and should
243718b35df8SHajimu UMEMOTO 	 * not be specified in the context of RFC3542.  Conversely,
243818b35df8SHajimu UMEMOTO 	 * RFC3542 types should not be specified in the context of RFC2292.
2439f95d4633SHajimu UMEMOTO 	 */
2440f95d4633SHajimu UMEMOTO 	if (!cmsg) {
2441f95d4633SHajimu UMEMOTO 		switch (optname) {
2442f95d4633SHajimu UMEMOTO 		case IPV6_2292PKTINFO:
2443f95d4633SHajimu UMEMOTO 		case IPV6_2292HOPLIMIT:
2444f95d4633SHajimu UMEMOTO 		case IPV6_2292NEXTHOP:
2445f95d4633SHajimu UMEMOTO 		case IPV6_2292HOPOPTS:
2446f95d4633SHajimu UMEMOTO 		case IPV6_2292DSTOPTS:
2447f95d4633SHajimu UMEMOTO 		case IPV6_2292RTHDR:
2448f95d4633SHajimu UMEMOTO 		case IPV6_2292PKTOPTIONS:
2449f95d4633SHajimu UMEMOTO 			return (ENOPROTOOPT);
2450f95d4633SHajimu UMEMOTO 		}
2451f95d4633SHajimu UMEMOTO 	}
2452f95d4633SHajimu UMEMOTO 	if (sticky && cmsg) {
2453f95d4633SHajimu UMEMOTO 		switch (optname) {
2454f95d4633SHajimu UMEMOTO 		case IPV6_PKTINFO:
2455f95d4633SHajimu UMEMOTO 		case IPV6_HOPLIMIT:
2456f95d4633SHajimu UMEMOTO 		case IPV6_NEXTHOP:
2457f95d4633SHajimu UMEMOTO 		case IPV6_HOPOPTS:
2458f95d4633SHajimu UMEMOTO 		case IPV6_DSTOPTS:
2459f95d4633SHajimu UMEMOTO 		case IPV6_RTHDRDSTOPTS:
2460f95d4633SHajimu UMEMOTO 		case IPV6_RTHDR:
2461f95d4633SHajimu UMEMOTO 		case IPV6_USE_MIN_MTU:
2462f95d4633SHajimu UMEMOTO 		case IPV6_DONTFRAG:
2463f95d4633SHajimu UMEMOTO 		case IPV6_TCLASS:
246418b35df8SHajimu UMEMOTO 		case IPV6_PREFER_TEMPADDR: /* XXX: not an RFC3542 option */
2465f95d4633SHajimu UMEMOTO 			return (ENOPROTOOPT);
2466f95d4633SHajimu UMEMOTO 		}
2467f95d4633SHajimu UMEMOTO 	}
2468f95d4633SHajimu UMEMOTO 
2469f95d4633SHajimu UMEMOTO 	switch (optname) {
2470f95d4633SHajimu UMEMOTO 	case IPV6_2292PKTINFO:
2471f95d4633SHajimu UMEMOTO 	case IPV6_PKTINFO:
2472f95d4633SHajimu UMEMOTO 	{
2473f95d4633SHajimu UMEMOTO 		struct ifnet *ifp = NULL;
2474f95d4633SHajimu UMEMOTO 		struct in6_pktinfo *pktinfo;
2475f95d4633SHajimu UMEMOTO 
2476f95d4633SHajimu UMEMOTO 		if (len != sizeof(struct in6_pktinfo))
2477f95d4633SHajimu UMEMOTO 			return (EINVAL);
2478f95d4633SHajimu UMEMOTO 
2479f95d4633SHajimu UMEMOTO 		pktinfo = (struct in6_pktinfo *)buf;
2480f95d4633SHajimu UMEMOTO 
2481f95d4633SHajimu UMEMOTO 		/*
2482f95d4633SHajimu UMEMOTO 		 * An application can clear any sticky IPV6_PKTINFO option by
2483f95d4633SHajimu UMEMOTO 		 * doing a "regular" setsockopt with ipi6_addr being
2484f95d4633SHajimu UMEMOTO 		 * in6addr_any and ipi6_ifindex being zero.
2485f95d4633SHajimu UMEMOTO 		 * [RFC 3542, Section 6]
2486f95d4633SHajimu UMEMOTO 		 */
2487f95d4633SHajimu UMEMOTO 		if (optname == IPV6_PKTINFO && opt->ip6po_pktinfo &&
2488f95d4633SHajimu UMEMOTO 		    pktinfo->ipi6_ifindex == 0 &&
2489f95d4633SHajimu UMEMOTO 		    IN6_IS_ADDR_UNSPECIFIED(&pktinfo->ipi6_addr)) {
2490f95d4633SHajimu UMEMOTO 			ip6_clearpktopts(opt, optname);
2491f95d4633SHajimu UMEMOTO 			break;
2492f95d4633SHajimu UMEMOTO 		}
2493f95d4633SHajimu UMEMOTO 
2494f95d4633SHajimu UMEMOTO 		if (uproto == IPPROTO_TCP && optname == IPV6_PKTINFO &&
2495f95d4633SHajimu UMEMOTO 		    sticky && !IN6_IS_ADDR_UNSPECIFIED(&pktinfo->ipi6_addr)) {
2496f95d4633SHajimu UMEMOTO 			return (EINVAL);
2497f95d4633SHajimu UMEMOTO 		}
2498f95d4633SHajimu UMEMOTO 
2499f95d4633SHajimu UMEMOTO 		/* validate the interface index if specified. */
2500603724d3SBjoern A. Zeeb 		if (pktinfo->ipi6_ifindex > V_if_index ||
2501f95d4633SHajimu UMEMOTO 		    pktinfo->ipi6_ifindex < 0) {
2502f95d4633SHajimu UMEMOTO 			 return (ENXIO);
2503f95d4633SHajimu UMEMOTO 		}
2504f95d4633SHajimu UMEMOTO 		if (pktinfo->ipi6_ifindex) {
2505f95d4633SHajimu UMEMOTO 			ifp = ifnet_byindex(pktinfo->ipi6_ifindex);
2506f95d4633SHajimu UMEMOTO 			if (ifp == NULL)
250782cd038dSYoshinobu Inoue 				return (ENXIO);
250882cd038dSYoshinobu Inoue 		}
250982cd038dSYoshinobu Inoue 
251033841545SHajimu UMEMOTO 		/*
2511f95d4633SHajimu UMEMOTO 		 * We store the address anyway, and let in6_selectsrc()
2512f95d4633SHajimu UMEMOTO 		 * validate the specified address.  This is because ipi6_addr
2513f95d4633SHajimu UMEMOTO 		 * may not have enough information about its scope zone, and
2514f95d4633SHajimu UMEMOTO 		 * we may need additional information (such as outgoing
2515f95d4633SHajimu UMEMOTO 		 * interface or the scope zone of a destination address) to
2516f95d4633SHajimu UMEMOTO 		 * disambiguate the scope.
2517f95d4633SHajimu UMEMOTO 		 * XXX: the delay of the validation may confuse the
2518f95d4633SHajimu UMEMOTO 		 * application when it is used as a sticky option.
251933841545SHajimu UMEMOTO 		 */
2520f95d4633SHajimu UMEMOTO 		if (opt->ip6po_pktinfo == NULL) {
2521f95d4633SHajimu UMEMOTO 			opt->ip6po_pktinfo = malloc(sizeof(*pktinfo),
2522885adbfaSHajimu UMEMOTO 			    M_IP6OPT, M_NOWAIT);
2523885adbfaSHajimu UMEMOTO 			if (opt->ip6po_pktinfo == NULL)
2524885adbfaSHajimu UMEMOTO 				return (ENOBUFS);
252582cd038dSYoshinobu Inoue 		}
2526f95d4633SHajimu UMEMOTO 		bcopy(pktinfo, opt->ip6po_pktinfo, sizeof(*pktinfo));
252782cd038dSYoshinobu Inoue 		break;
2528f95d4633SHajimu UMEMOTO 	}
252982cd038dSYoshinobu Inoue 
2530f95d4633SHajimu UMEMOTO 	case IPV6_2292HOPLIMIT:
253182cd038dSYoshinobu Inoue 	case IPV6_HOPLIMIT:
2532f95d4633SHajimu UMEMOTO 	{
2533f95d4633SHajimu UMEMOTO 		int *hlimp;
2534f95d4633SHajimu UMEMOTO 
2535f95d4633SHajimu UMEMOTO 		/*
2536f95d4633SHajimu UMEMOTO 		 * RFC 3542 deprecated the usage of sticky IPV6_HOPLIMIT
2537f95d4633SHajimu UMEMOTO 		 * to simplify the ordering among hoplimit options.
2538f95d4633SHajimu UMEMOTO 		 */
2539f95d4633SHajimu UMEMOTO 		if (optname == IPV6_HOPLIMIT && sticky)
2540f95d4633SHajimu UMEMOTO 			return (ENOPROTOOPT);
2541f95d4633SHajimu UMEMOTO 
2542f95d4633SHajimu UMEMOTO 		if (len != sizeof(int))
2543f95d4633SHajimu UMEMOTO 			return (EINVAL);
2544f95d4633SHajimu UMEMOTO 		hlimp = (int *)buf;
2545f95d4633SHajimu UMEMOTO 		if (*hlimp < -1 || *hlimp > 255)
254682cd038dSYoshinobu Inoue 			return (EINVAL);
254782cd038dSYoshinobu Inoue 
2548f95d4633SHajimu UMEMOTO 		opt->ip6po_hlim = *hlimp;
254982cd038dSYoshinobu Inoue 		break;
2550f95d4633SHajimu UMEMOTO 	}
255182cd038dSYoshinobu Inoue 
2552f95d4633SHajimu UMEMOTO 	case IPV6_TCLASS:
2553f95d4633SHajimu UMEMOTO 	{
2554f95d4633SHajimu UMEMOTO 		int tclass;
2555f95d4633SHajimu UMEMOTO 
2556f95d4633SHajimu UMEMOTO 		if (len != sizeof(int))
2557f95d4633SHajimu UMEMOTO 			return (EINVAL);
2558f95d4633SHajimu UMEMOTO 		tclass = *(int *)buf;
2559f95d4633SHajimu UMEMOTO 		if (tclass < -1 || tclass > 255)
2560f95d4633SHajimu UMEMOTO 			return (EINVAL);
2561f95d4633SHajimu UMEMOTO 
2562f95d4633SHajimu UMEMOTO 		opt->ip6po_tclass = tclass;
2563f95d4633SHajimu UMEMOTO 		break;
2564f95d4633SHajimu UMEMOTO 	}
2565f95d4633SHajimu UMEMOTO 
2566f95d4633SHajimu UMEMOTO 	case IPV6_2292NEXTHOP:
256782cd038dSYoshinobu Inoue 	case IPV6_NEXTHOP:
256879ba3952SBjoern A. Zeeb 		if (cred != NULL) {
256979ba3952SBjoern A. Zeeb 			error = priv_check_cred(cred,
257079ba3952SBjoern A. Zeeb 			    PRIV_NETINET_SETHDROPTS, 0);
257179ba3952SBjoern A. Zeeb 			if (error)
257279ba3952SBjoern A. Zeeb 				return (error);
257379ba3952SBjoern A. Zeeb 		}
257433841545SHajimu UMEMOTO 
2575f95d4633SHajimu UMEMOTO 		if (len == 0) {	/* just remove the option */
2576f95d4633SHajimu UMEMOTO 			ip6_clearpktopts(opt, IPV6_NEXTHOP);
2577f95d4633SHajimu UMEMOTO 			break;
2578f95d4633SHajimu UMEMOTO 		}
2579f95d4633SHajimu UMEMOTO 
258033841545SHajimu UMEMOTO 		/* check if cmsg_len is large enough for sa_len */
2581f95d4633SHajimu UMEMOTO 		if (len < sizeof(struct sockaddr) || len < *buf)
258282cd038dSYoshinobu Inoue 			return (EINVAL);
258382cd038dSYoshinobu Inoue 
2584f95d4633SHajimu UMEMOTO 		switch (((struct sockaddr *)buf)->sa_family) {
2585f95d4633SHajimu UMEMOTO 		case AF_INET6:
2586f95d4633SHajimu UMEMOTO 		{
2587f95d4633SHajimu UMEMOTO 			struct sockaddr_in6 *sa6 = (struct sockaddr_in6 *)buf;
2588f95d4633SHajimu UMEMOTO 			int error;
2589f95d4633SHajimu UMEMOTO 
2590f95d4633SHajimu UMEMOTO 			if (sa6->sin6_len != sizeof(struct sockaddr_in6))
2591f95d4633SHajimu UMEMOTO 				return (EINVAL);
2592f95d4633SHajimu UMEMOTO 
2593f95d4633SHajimu UMEMOTO 			if (IN6_IS_ADDR_UNSPECIFIED(&sa6->sin6_addr) ||
2594f95d4633SHajimu UMEMOTO 			    IN6_IS_ADDR_MULTICAST(&sa6->sin6_addr)) {
2595f95d4633SHajimu UMEMOTO 				return (EINVAL);
2596f95d4633SHajimu UMEMOTO 			}
2597603724d3SBjoern A. Zeeb 			if ((error = sa6_embedscope(sa6, V_ip6_use_defzone))
2598f95d4633SHajimu UMEMOTO 			    != 0) {
2599f95d4633SHajimu UMEMOTO 				return (error);
2600f95d4633SHajimu UMEMOTO 			}
2601f95d4633SHajimu UMEMOTO 			break;
2602f95d4633SHajimu UMEMOTO 		}
2603f95d4633SHajimu UMEMOTO 		case AF_LINK:	/* should eventually be supported */
2604f95d4633SHajimu UMEMOTO 		default:
2605f95d4633SHajimu UMEMOTO 			return (EAFNOSUPPORT);
2606f95d4633SHajimu UMEMOTO 		}
2607f95d4633SHajimu UMEMOTO 
2608f95d4633SHajimu UMEMOTO 		/* turn off the previous option, then set the new option. */
2609f95d4633SHajimu UMEMOTO 		ip6_clearpktopts(opt, IPV6_NEXTHOP);
2610743eee66SSUZUKI Shinsuke 		opt->ip6po_nexthop = malloc(*buf, M_IP6OPT, M_NOWAIT);
2611743eee66SSUZUKI Shinsuke 		if (opt->ip6po_nexthop == NULL)
2612743eee66SSUZUKI Shinsuke 			return (ENOBUFS);
2613f95d4633SHajimu UMEMOTO 		bcopy(buf, opt->ip6po_nexthop, *buf);
261482cd038dSYoshinobu Inoue 		break;
261582cd038dSYoshinobu Inoue 
2616f95d4633SHajimu UMEMOTO 	case IPV6_2292HOPOPTS:
261782cd038dSYoshinobu Inoue 	case IPV6_HOPOPTS:
261833841545SHajimu UMEMOTO 	{
261933841545SHajimu UMEMOTO 		struct ip6_hbh *hbh;
262033841545SHajimu UMEMOTO 		int hbhlen;
262133841545SHajimu UMEMOTO 
2622f95d4633SHajimu UMEMOTO 		/*
2623f95d4633SHajimu UMEMOTO 		 * XXX: We don't allow a non-privileged user to set ANY HbH
2624f95d4633SHajimu UMEMOTO 		 * options, since per-option restriction has too much
2625f95d4633SHajimu UMEMOTO 		 * overhead.
2626f95d4633SHajimu UMEMOTO 		 */
262779ba3952SBjoern A. Zeeb 		if (cred != NULL) {
262879ba3952SBjoern A. Zeeb 			error = priv_check_cred(cred,
262979ba3952SBjoern A. Zeeb 			    PRIV_NETINET_SETHDROPTS, 0);
263079ba3952SBjoern A. Zeeb 			if (error)
263179ba3952SBjoern A. Zeeb 				return (error);
263279ba3952SBjoern A. Zeeb 		}
2633f95d4633SHajimu UMEMOTO 
2634f95d4633SHajimu UMEMOTO 		if (len == 0) {
2635f95d4633SHajimu UMEMOTO 			ip6_clearpktopts(opt, IPV6_HOPOPTS);
2636f95d4633SHajimu UMEMOTO 			break;	/* just remove the option */
2637f95d4633SHajimu UMEMOTO 		}
2638f95d4633SHajimu UMEMOTO 
2639f95d4633SHajimu UMEMOTO 		/* message length validation */
2640f95d4633SHajimu UMEMOTO 		if (len < sizeof(struct ip6_hbh))
264182cd038dSYoshinobu Inoue 			return (EINVAL);
2642f95d4633SHajimu UMEMOTO 		hbh = (struct ip6_hbh *)buf;
264333841545SHajimu UMEMOTO 		hbhlen = (hbh->ip6h_len + 1) << 3;
2644f95d4633SHajimu UMEMOTO 		if (len != hbhlen)
264582cd038dSYoshinobu Inoue 			return (EINVAL);
264633841545SHajimu UMEMOTO 
2647f95d4633SHajimu UMEMOTO 		/* turn off the previous option, then set the new option. */
2648f95d4633SHajimu UMEMOTO 		ip6_clearpktopts(opt, IPV6_HOPOPTS);
2649743eee66SSUZUKI Shinsuke 		opt->ip6po_hbh = malloc(hbhlen, M_IP6OPT, M_NOWAIT);
2650743eee66SSUZUKI Shinsuke 		if (opt->ip6po_hbh == NULL)
2651743eee66SSUZUKI Shinsuke 			return (ENOBUFS);
265233841545SHajimu UMEMOTO 		bcopy(hbh, opt->ip6po_hbh, hbhlen);
2653f95d4633SHajimu UMEMOTO 
265482cd038dSYoshinobu Inoue 		break;
265533841545SHajimu UMEMOTO 	}
265682cd038dSYoshinobu Inoue 
2657f95d4633SHajimu UMEMOTO 	case IPV6_2292DSTOPTS:
265882cd038dSYoshinobu Inoue 	case IPV6_DSTOPTS:
2659f95d4633SHajimu UMEMOTO 	case IPV6_RTHDRDSTOPTS:
266033841545SHajimu UMEMOTO 	{
2661f95d4633SHajimu UMEMOTO 		struct ip6_dest *dest, **newdest = NULL;
266233841545SHajimu UMEMOTO 		int destlen;
266333841545SHajimu UMEMOTO 
266479ba3952SBjoern A. Zeeb 		if (cred != NULL) { /* XXX: see the comment for IPV6_HOPOPTS */
266579ba3952SBjoern A. Zeeb 			error = priv_check_cred(cred,
266679ba3952SBjoern A. Zeeb 			    PRIV_NETINET_SETHDROPTS, 0);
266779ba3952SBjoern A. Zeeb 			if (error)
266879ba3952SBjoern A. Zeeb 				return (error);
266979ba3952SBjoern A. Zeeb 		}
2670f95d4633SHajimu UMEMOTO 
2671f95d4633SHajimu UMEMOTO 		if (len == 0) {
2672f95d4633SHajimu UMEMOTO 			ip6_clearpktopts(opt, optname);
2673f95d4633SHajimu UMEMOTO 			break;	/* just remove the option */
2674f95d4633SHajimu UMEMOTO 		}
2675f95d4633SHajimu UMEMOTO 
2676f95d4633SHajimu UMEMOTO 		/* message length validation */
2677f95d4633SHajimu UMEMOTO 		if (len < sizeof(struct ip6_dest))
267882cd038dSYoshinobu Inoue 			return (EINVAL);
2679f95d4633SHajimu UMEMOTO 		dest = (struct ip6_dest *)buf;
268033841545SHajimu UMEMOTO 		destlen = (dest->ip6d_len + 1) << 3;
2681f95d4633SHajimu UMEMOTO 		if (len != destlen)
268233841545SHajimu UMEMOTO 			return (EINVAL);
268382cd038dSYoshinobu Inoue 
268482cd038dSYoshinobu Inoue 		/*
2685f95d4633SHajimu UMEMOTO 		 * Determine the position that the destination options header
2686f95d4633SHajimu UMEMOTO 		 * should be inserted; before or after the routing header.
2687f95d4633SHajimu UMEMOTO 		 */
2688f95d4633SHajimu UMEMOTO 		switch (optname) {
2689f95d4633SHajimu UMEMOTO 		case IPV6_2292DSTOPTS:
2690f95d4633SHajimu UMEMOTO 			/*
2691f95d4633SHajimu UMEMOTO 			 * The old advacned API is ambiguous on this point.
2692f95d4633SHajimu UMEMOTO 			 * Our approach is to determine the position based
2693f95d4633SHajimu UMEMOTO 			 * according to the existence of a routing header.
2694f95d4633SHajimu UMEMOTO 			 * Note, however, that this depends on the order of the
2695f95d4633SHajimu UMEMOTO 			 * extension headers in the ancillary data; the 1st
2696f95d4633SHajimu UMEMOTO 			 * part of the destination options header must appear
2697f95d4633SHajimu UMEMOTO 			 * before the routing header in the ancillary data,
2698f95d4633SHajimu UMEMOTO 			 * too.
269918b35df8SHajimu UMEMOTO 			 * RFC3542 solved the ambiguity by introducing
2700f95d4633SHajimu UMEMOTO 			 * separate ancillary data or option types.
270182cd038dSYoshinobu Inoue 			 */
270233841545SHajimu UMEMOTO 			if (opt->ip6po_rthdr == NULL)
270333841545SHajimu UMEMOTO 				newdest = &opt->ip6po_dest1;
270433841545SHajimu UMEMOTO 			else
270533841545SHajimu UMEMOTO 				newdest = &opt->ip6po_dest2;
2706f95d4633SHajimu UMEMOTO 			break;
2707f95d4633SHajimu UMEMOTO 		case IPV6_RTHDRDSTOPTS:
2708f95d4633SHajimu UMEMOTO 			newdest = &opt->ip6po_dest1;
2709f95d4633SHajimu UMEMOTO 			break;
2710f95d4633SHajimu UMEMOTO 		case IPV6_DSTOPTS:
2711f95d4633SHajimu UMEMOTO 			newdest = &opt->ip6po_dest2;
2712f95d4633SHajimu UMEMOTO 			break;
2713f95d4633SHajimu UMEMOTO 		}
271433841545SHajimu UMEMOTO 
2715f95d4633SHajimu UMEMOTO 		/* turn off the previous option, then set the new option. */
2716f95d4633SHajimu UMEMOTO 		ip6_clearpktopts(opt, optname);
2717743eee66SSUZUKI Shinsuke 		*newdest = malloc(destlen, M_IP6OPT, M_NOWAIT);
2718fc4c8258SRobert Watson 		if (*newdest == NULL)
2719743eee66SSUZUKI Shinsuke 			return (ENOBUFS);
272033841545SHajimu UMEMOTO 		bcopy(dest, *newdest, destlen);
272133841545SHajimu UMEMOTO 
272282cd038dSYoshinobu Inoue 		break;
272333841545SHajimu UMEMOTO 	}
272482cd038dSYoshinobu Inoue 
2725f95d4633SHajimu UMEMOTO 	case IPV6_2292RTHDR:
272682cd038dSYoshinobu Inoue 	case IPV6_RTHDR:
272733841545SHajimu UMEMOTO 	{
272833841545SHajimu UMEMOTO 		struct ip6_rthdr *rth;
272933841545SHajimu UMEMOTO 		int rthlen;
273033841545SHajimu UMEMOTO 
2731f95d4633SHajimu UMEMOTO 		if (len == 0) {
2732f95d4633SHajimu UMEMOTO 			ip6_clearpktopts(opt, IPV6_RTHDR);
2733f95d4633SHajimu UMEMOTO 			break;	/* just remove the option */
2734f95d4633SHajimu UMEMOTO 		}
2735f95d4633SHajimu UMEMOTO 
2736f95d4633SHajimu UMEMOTO 		/* message length validation */
2737f95d4633SHajimu UMEMOTO 		if (len < sizeof(struct ip6_rthdr))
273882cd038dSYoshinobu Inoue 			return (EINVAL);
2739f95d4633SHajimu UMEMOTO 		rth = (struct ip6_rthdr *)buf;
274033841545SHajimu UMEMOTO 		rthlen = (rth->ip6r_len + 1) << 3;
2741f95d4633SHajimu UMEMOTO 		if (len != rthlen)
274282cd038dSYoshinobu Inoue 			return (EINVAL);
274333841545SHajimu UMEMOTO 
274433841545SHajimu UMEMOTO 		switch (rth->ip6r_type) {
274582cd038dSYoshinobu Inoue 		case IPV6_RTHDR_TYPE_0:
2746f95d4633SHajimu UMEMOTO 			if (rth->ip6r_len == 0)	/* must contain one addr */
274733841545SHajimu UMEMOTO 				return (EINVAL);
2748f95d4633SHajimu UMEMOTO 			if (rth->ip6r_len % 2) /* length must be even */
274933841545SHajimu UMEMOTO 				return (EINVAL);
275033841545SHajimu UMEMOTO 			if (rth->ip6r_len / 2 != rth->ip6r_segleft)
275182cd038dSYoshinobu Inoue 				return (EINVAL);
275282cd038dSYoshinobu Inoue 			break;
275382cd038dSYoshinobu Inoue 		default:
275433841545SHajimu UMEMOTO 			return (EINVAL);	/* not supported */
275582cd038dSYoshinobu Inoue 		}
275633841545SHajimu UMEMOTO 
2757f95d4633SHajimu UMEMOTO 		/* turn off the previous option */
2758f95d4633SHajimu UMEMOTO 		ip6_clearpktopts(opt, IPV6_RTHDR);
2759743eee66SSUZUKI Shinsuke 		opt->ip6po_rthdr = malloc(rthlen, M_IP6OPT, M_NOWAIT);
2760743eee66SSUZUKI Shinsuke 		if (opt->ip6po_rthdr == NULL)
2761743eee66SSUZUKI Shinsuke 			return (ENOBUFS);
276233841545SHajimu UMEMOTO 		bcopy(rth, opt->ip6po_rthdr, rthlen);
276333841545SHajimu UMEMOTO 
276482cd038dSYoshinobu Inoue 		break;
276533841545SHajimu UMEMOTO 	}
276682cd038dSYoshinobu Inoue 
2767f95d4633SHajimu UMEMOTO 	case IPV6_USE_MIN_MTU:
2768f95d4633SHajimu UMEMOTO 		if (len != sizeof(int))
2769f95d4633SHajimu UMEMOTO 			return (EINVAL);
2770f95d4633SHajimu UMEMOTO 		minmtupolicy = *(int *)buf;
2771f95d4633SHajimu UMEMOTO 		if (minmtupolicy != IP6PO_MINMTU_MCASTONLY &&
2772f95d4633SHajimu UMEMOTO 		    minmtupolicy != IP6PO_MINMTU_DISABLE &&
2773f95d4633SHajimu UMEMOTO 		    minmtupolicy != IP6PO_MINMTU_ALL) {
2774f95d4633SHajimu UMEMOTO 			return (EINVAL);
2775f95d4633SHajimu UMEMOTO 		}
2776f95d4633SHajimu UMEMOTO 		opt->ip6po_minmtu = minmtupolicy;
2777f95d4633SHajimu UMEMOTO 		break;
2778f95d4633SHajimu UMEMOTO 
2779f95d4633SHajimu UMEMOTO 	case IPV6_DONTFRAG:
2780f95d4633SHajimu UMEMOTO 		if (len != sizeof(int))
2781f95d4633SHajimu UMEMOTO 			return (EINVAL);
2782f95d4633SHajimu UMEMOTO 
2783f95d4633SHajimu UMEMOTO 		if (uproto == IPPROTO_TCP || *(int *)buf == 0) {
2784f95d4633SHajimu UMEMOTO 			/*
2785f95d4633SHajimu UMEMOTO 			 * we ignore this option for TCP sockets.
278618b35df8SHajimu UMEMOTO 			 * (RFC3542 leaves this case unspecified.)
2787f95d4633SHajimu UMEMOTO 			 */
2788f95d4633SHajimu UMEMOTO 			opt->ip6po_flags &= ~IP6PO_DONTFRAG;
2789f95d4633SHajimu UMEMOTO 		} else
2790f95d4633SHajimu UMEMOTO 			opt->ip6po_flags |= IP6PO_DONTFRAG;
2791f95d4633SHajimu UMEMOTO 		break;
2792f95d4633SHajimu UMEMOTO 
2793f95d4633SHajimu UMEMOTO 	case IPV6_PREFER_TEMPADDR:
2794f95d4633SHajimu UMEMOTO 		if (len != sizeof(int))
2795f95d4633SHajimu UMEMOTO 			return (EINVAL);
2796f95d4633SHajimu UMEMOTO 		preftemp = *(int *)buf;
2797f95d4633SHajimu UMEMOTO 		if (preftemp != IP6PO_TEMPADDR_SYSTEM &&
2798f95d4633SHajimu UMEMOTO 		    preftemp != IP6PO_TEMPADDR_NOTPREFER &&
2799f95d4633SHajimu UMEMOTO 		    preftemp != IP6PO_TEMPADDR_PREFER) {
2800f95d4633SHajimu UMEMOTO 			return (EINVAL);
2801f95d4633SHajimu UMEMOTO 		}
2802f95d4633SHajimu UMEMOTO 		opt->ip6po_prefer_tempaddr = preftemp;
2803f95d4633SHajimu UMEMOTO 		break;
2804f95d4633SHajimu UMEMOTO 
280582cd038dSYoshinobu Inoue 	default:
280682cd038dSYoshinobu Inoue 		return (ENOPROTOOPT);
2807f95d4633SHajimu UMEMOTO 	} /* end of switch */
280882cd038dSYoshinobu Inoue 
280982cd038dSYoshinobu Inoue 	return (0);
281082cd038dSYoshinobu Inoue }
281182cd038dSYoshinobu Inoue 
281282cd038dSYoshinobu Inoue /*
281382cd038dSYoshinobu Inoue  * Routine called from ip6_output() to loop back a copy of an IP6 multicast
281482cd038dSYoshinobu Inoue  * packet to the input queue of a specified interface.  Note that this
281582cd038dSYoshinobu Inoue  * calls the output routine of the loopback "driver", but with an interface
281682cd038dSYoshinobu Inoue  * pointer that might NOT be &loif -- easier than replicating that code here.
281782cd038dSYoshinobu Inoue  */
281882cd038dSYoshinobu Inoue void
28191272577eSXin LI ip6_mloopback(struct ifnet *ifp, struct mbuf *m, struct sockaddr_in6 *dst)
282082cd038dSYoshinobu Inoue {
282182cd038dSYoshinobu Inoue 	struct mbuf *copym;
2822686cdd19SJun-ichiro itojun Hagino 	struct ip6_hdr *ip6;
282382cd038dSYoshinobu Inoue 
282482cd038dSYoshinobu Inoue 	copym = m_copy(m, 0, M_COPYALL);
2825686cdd19SJun-ichiro itojun Hagino 	if (copym == NULL)
2826686cdd19SJun-ichiro itojun Hagino 		return;
2827686cdd19SJun-ichiro itojun Hagino 
2828686cdd19SJun-ichiro itojun Hagino 	/*
2829686cdd19SJun-ichiro itojun Hagino 	 * Make sure to deep-copy IPv6 header portion in case the data
2830686cdd19SJun-ichiro itojun Hagino 	 * is in an mbuf cluster, so that we can safely override the IPv6
2831686cdd19SJun-ichiro itojun Hagino 	 * header portion later.
2832686cdd19SJun-ichiro itojun Hagino 	 */
2833686cdd19SJun-ichiro itojun Hagino 	if ((copym->m_flags & M_EXT) != 0 ||
2834686cdd19SJun-ichiro itojun Hagino 	    copym->m_len < sizeof(struct ip6_hdr)) {
2835686cdd19SJun-ichiro itojun Hagino 		copym = m_pullup(copym, sizeof(struct ip6_hdr));
2836686cdd19SJun-ichiro itojun Hagino 		if (copym == NULL)
2837686cdd19SJun-ichiro itojun Hagino 			return;
283882cd038dSYoshinobu Inoue 	}
2839686cdd19SJun-ichiro itojun Hagino 
2840686cdd19SJun-ichiro itojun Hagino #ifdef DIAGNOSTIC
2841686cdd19SJun-ichiro itojun Hagino 	if (copym->m_len < sizeof(*ip6)) {
2842686cdd19SJun-ichiro itojun Hagino 		m_freem(copym);
2843686cdd19SJun-ichiro itojun Hagino 		return;
2844686cdd19SJun-ichiro itojun Hagino 	}
2845686cdd19SJun-ichiro itojun Hagino #endif
2846686cdd19SJun-ichiro itojun Hagino 
2847686cdd19SJun-ichiro itojun Hagino 	ip6 = mtod(copym, struct ip6_hdr *);
284833841545SHajimu UMEMOTO 	/*
284933841545SHajimu UMEMOTO 	 * clear embedded scope identifiers if necessary.
285033841545SHajimu UMEMOTO 	 * in6_clearscope will touch the addresses only when necessary.
285133841545SHajimu UMEMOTO 	 */
285233841545SHajimu UMEMOTO 	in6_clearscope(&ip6->ip6_src);
285333841545SHajimu UMEMOTO 	in6_clearscope(&ip6->ip6_dst);
2854686cdd19SJun-ichiro itojun Hagino 
2855a89ec05eSPeter Wemm 	(void)if_simloop(ifp, copym, dst->sin6_family, 0);
285682cd038dSYoshinobu Inoue }
285782cd038dSYoshinobu Inoue 
285882cd038dSYoshinobu Inoue /*
285982cd038dSYoshinobu Inoue  * Chop IPv6 header off from the payload.
286082cd038dSYoshinobu Inoue  */
286182cd038dSYoshinobu Inoue static int
28621272577eSXin LI ip6_splithdr(struct mbuf *m, struct ip6_exthdrs *exthdrs)
286382cd038dSYoshinobu Inoue {
286482cd038dSYoshinobu Inoue 	struct mbuf *mh;
286582cd038dSYoshinobu Inoue 	struct ip6_hdr *ip6;
286682cd038dSYoshinobu Inoue 
286782cd038dSYoshinobu Inoue 	ip6 = mtod(m, struct ip6_hdr *);
286882cd038dSYoshinobu Inoue 	if (m->m_len > sizeof(*ip6)) {
2869a163d034SWarner Losh 		MGETHDR(mh, M_DONTWAIT, MT_HEADER);
287082cd038dSYoshinobu Inoue 		if (mh == 0) {
287182cd038dSYoshinobu Inoue 			m_freem(m);
287282cd038dSYoshinobu Inoue 			return ENOBUFS;
287382cd038dSYoshinobu Inoue 		}
28749967cafcSSam Leffler 		M_MOVE_PKTHDR(mh, m);
287582cd038dSYoshinobu Inoue 		MH_ALIGN(mh, sizeof(*ip6));
287682cd038dSYoshinobu Inoue 		m->m_len -= sizeof(*ip6);
287782cd038dSYoshinobu Inoue 		m->m_data += sizeof(*ip6);
287882cd038dSYoshinobu Inoue 		mh->m_next = m;
287982cd038dSYoshinobu Inoue 		m = mh;
288082cd038dSYoshinobu Inoue 		m->m_len = sizeof(*ip6);
288182cd038dSYoshinobu Inoue 		bcopy((caddr_t)ip6, mtod(m, caddr_t), sizeof(*ip6));
288282cd038dSYoshinobu Inoue 	}
288382cd038dSYoshinobu Inoue 	exthdrs->ip6e_ip6 = m;
288482cd038dSYoshinobu Inoue 	return 0;
288582cd038dSYoshinobu Inoue }
288682cd038dSYoshinobu Inoue 
288782cd038dSYoshinobu Inoue /*
288882cd038dSYoshinobu Inoue  * Compute IPv6 extension header length.
288982cd038dSYoshinobu Inoue  */
289082cd038dSYoshinobu Inoue int
2891fc384fa5SBjoern A. Zeeb ip6_optlen(struct inpcb *in6p)
289282cd038dSYoshinobu Inoue {
289382cd038dSYoshinobu Inoue 	int len;
289482cd038dSYoshinobu Inoue 
289582cd038dSYoshinobu Inoue 	if (!in6p->in6p_outputopts)
289682cd038dSYoshinobu Inoue 		return 0;
289782cd038dSYoshinobu Inoue 
289882cd038dSYoshinobu Inoue 	len = 0;
289982cd038dSYoshinobu Inoue #define elen(x) \
290082cd038dSYoshinobu Inoue     (((struct ip6_ext *)(x)) ? (((struct ip6_ext *)(x))->ip6e_len + 1) << 3 : 0)
290182cd038dSYoshinobu Inoue 
290282cd038dSYoshinobu Inoue 	len += elen(in6p->in6p_outputopts->ip6po_hbh);
290333841545SHajimu UMEMOTO 	if (in6p->in6p_outputopts->ip6po_rthdr)
290433841545SHajimu UMEMOTO 		/* dest1 is valid with rthdr only */
290582cd038dSYoshinobu Inoue 		len += elen(in6p->in6p_outputopts->ip6po_dest1);
290682cd038dSYoshinobu Inoue 	len += elen(in6p->in6p_outputopts->ip6po_rthdr);
290782cd038dSYoshinobu Inoue 	len += elen(in6p->in6p_outputopts->ip6po_dest2);
290882cd038dSYoshinobu Inoue 	return len;
290982cd038dSYoshinobu Inoue #undef elen
291082cd038dSYoshinobu Inoue }
2911