xref: /freebsd/sys/netinet6/ip6_output.c (revision 02b9a2066e21abc80cba2cf3295af96879e3e6e0)
1686cdd19SJun-ichiro itojun Hagino /*	$FreeBSD$	*/
288ff5695SSUZUKI Shinsuke /*	$KAME: ip6_output.c,v 1.279 2002/01/26 06:12:30 jinmei Exp $	*/
3686cdd19SJun-ichiro itojun Hagino 
482cd038dSYoshinobu Inoue /*
582cd038dSYoshinobu Inoue  * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project.
682cd038dSYoshinobu Inoue  * All rights reserved.
782cd038dSYoshinobu Inoue  *
882cd038dSYoshinobu Inoue  * Redistribution and use in source and binary forms, with or without
982cd038dSYoshinobu Inoue  * modification, are permitted provided that the following conditions
1082cd038dSYoshinobu Inoue  * are met:
1182cd038dSYoshinobu Inoue  * 1. Redistributions of source code must retain the above copyright
1282cd038dSYoshinobu Inoue  *    notice, this list of conditions and the following disclaimer.
1382cd038dSYoshinobu Inoue  * 2. Redistributions in binary form must reproduce the above copyright
1482cd038dSYoshinobu Inoue  *    notice, this list of conditions and the following disclaimer in the
1582cd038dSYoshinobu Inoue  *    documentation and/or other materials provided with the distribution.
1682cd038dSYoshinobu Inoue  * 3. Neither the name of the project nor the names of its contributors
1782cd038dSYoshinobu Inoue  *    may be used to endorse or promote products derived from this software
1882cd038dSYoshinobu Inoue  *    without specific prior written permission.
1982cd038dSYoshinobu Inoue  *
2082cd038dSYoshinobu Inoue  * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
2182cd038dSYoshinobu Inoue  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
2282cd038dSYoshinobu Inoue  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
2382cd038dSYoshinobu Inoue  * ARE DISCLAIMED.  IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
2482cd038dSYoshinobu Inoue  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
2582cd038dSYoshinobu Inoue  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
2682cd038dSYoshinobu Inoue  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
2782cd038dSYoshinobu Inoue  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
2882cd038dSYoshinobu Inoue  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
2982cd038dSYoshinobu Inoue  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
3082cd038dSYoshinobu Inoue  * SUCH DAMAGE.
3182cd038dSYoshinobu Inoue  */
3282cd038dSYoshinobu Inoue 
3382cd038dSYoshinobu Inoue /*
3482cd038dSYoshinobu Inoue  * Copyright (c) 1982, 1986, 1988, 1990, 1993
3582cd038dSYoshinobu Inoue  *	The Regents of the University of California.  All rights reserved.
3682cd038dSYoshinobu Inoue  *
3782cd038dSYoshinobu Inoue  * Redistribution and use in source and binary forms, with or without
3882cd038dSYoshinobu Inoue  * modification, are permitted provided that the following conditions
3982cd038dSYoshinobu Inoue  * are met:
4082cd038dSYoshinobu Inoue  * 1. Redistributions of source code must retain the above copyright
4182cd038dSYoshinobu Inoue  *    notice, this list of conditions and the following disclaimer.
4282cd038dSYoshinobu Inoue  * 2. Redistributions in binary form must reproduce the above copyright
4382cd038dSYoshinobu Inoue  *    notice, this list of conditions and the following disclaimer in the
4482cd038dSYoshinobu Inoue  *    documentation and/or other materials provided with the distribution.
4582cd038dSYoshinobu Inoue  * 3. All advertising materials mentioning features or use of this software
4682cd038dSYoshinobu Inoue  *    must display the following acknowledgement:
4782cd038dSYoshinobu Inoue  *	This product includes software developed by the University of
4882cd038dSYoshinobu Inoue  *	California, Berkeley and its contributors.
4982cd038dSYoshinobu Inoue  * 4. Neither the name of the University nor the names of its contributors
5082cd038dSYoshinobu Inoue  *    may be used to endorse or promote products derived from this software
5182cd038dSYoshinobu Inoue  *    without specific prior written permission.
5282cd038dSYoshinobu Inoue  *
5382cd038dSYoshinobu Inoue  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
5482cd038dSYoshinobu Inoue  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
5582cd038dSYoshinobu Inoue  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
5682cd038dSYoshinobu Inoue  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
5782cd038dSYoshinobu Inoue  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
5882cd038dSYoshinobu Inoue  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
5982cd038dSYoshinobu Inoue  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
6082cd038dSYoshinobu Inoue  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
6182cd038dSYoshinobu Inoue  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
6282cd038dSYoshinobu Inoue  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
6382cd038dSYoshinobu Inoue  * SUCH DAMAGE.
6482cd038dSYoshinobu Inoue  *
6582cd038dSYoshinobu Inoue  *	@(#)ip_output.c	8.3 (Berkeley) 1/21/94
6682cd038dSYoshinobu Inoue  */
6782cd038dSYoshinobu Inoue 
68210d0432SYoshinobu Inoue #include "opt_ip6fw.h"
69686cdd19SJun-ichiro itojun Hagino #include "opt_inet.h"
70686cdd19SJun-ichiro itojun Hagino #include "opt_inet6.h"
71686cdd19SJun-ichiro itojun Hagino #include "opt_ipsec.h"
72c4ac87eaSDarren Reed #include "opt_pfil_hooks.h"
7329234943SHajimu UMEMOTO #include "opt_random_ip_id.h"
7482cd038dSYoshinobu Inoue 
7582cd038dSYoshinobu Inoue #include <sys/param.h>
7682cd038dSYoshinobu Inoue #include <sys/malloc.h>
7782cd038dSYoshinobu Inoue #include <sys/mbuf.h>
78b40ce416SJulian Elischer #include <sys/proc.h>
7982cd038dSYoshinobu Inoue #include <sys/errno.h>
8082cd038dSYoshinobu Inoue #include <sys/protosw.h>
8182cd038dSYoshinobu Inoue #include <sys/socket.h>
8282cd038dSYoshinobu Inoue #include <sys/socketvar.h>
8382cd038dSYoshinobu Inoue #include <sys/systm.h>
8482cd038dSYoshinobu Inoue #include <sys/kernel.h>
8582cd038dSYoshinobu Inoue 
8682cd038dSYoshinobu Inoue #include <net/if.h>
8782cd038dSYoshinobu Inoue #include <net/route.h>
88c4ac87eaSDarren Reed #ifdef PFIL_HOOKS
89c4ac87eaSDarren Reed #include <net/pfil.h>
90c4ac87eaSDarren Reed #endif
9182cd038dSYoshinobu Inoue 
9282cd038dSYoshinobu Inoue #include <netinet/in.h>
9382cd038dSYoshinobu Inoue #include <netinet/in_var.h>
9433841545SHajimu UMEMOTO #include <netinet6/in6_var.h>
95686cdd19SJun-ichiro itojun Hagino #include <netinet/ip6.h>
96686cdd19SJun-ichiro itojun Hagino #include <netinet/icmp6.h>
9782cd038dSYoshinobu Inoue #include <netinet6/ip6_var.h>
98686cdd19SJun-ichiro itojun Hagino #include <netinet/in_pcb.h>
9982cd038dSYoshinobu Inoue #include <netinet6/nd6.h>
10082cd038dSYoshinobu Inoue 
10182cd038dSYoshinobu Inoue #ifdef IPSEC
10282cd038dSYoshinobu Inoue #include <netinet6/ipsec.h>
103686cdd19SJun-ichiro itojun Hagino #ifdef INET6
10482cd038dSYoshinobu Inoue #include <netinet6/ipsec6.h>
1056a800098SYoshinobu Inoue #endif
106686cdd19SJun-ichiro itojun Hagino #include <netkey/key.h>
10782cd038dSYoshinobu Inoue #endif /* IPSEC */
10882cd038dSYoshinobu Inoue 
109b9234fafSSam Leffler #ifdef FAST_IPSEC
110b9234fafSSam Leffler #include <netipsec/ipsec.h>
111b9234fafSSam Leffler #include <netipsec/ipsec6.h>
112b9234fafSSam Leffler #include <netipsec/key.h>
113b9234fafSSam Leffler #endif /* FAST_IPSEC */
114b9234fafSSam Leffler 
11582cd038dSYoshinobu Inoue #include <netinet6/ip6_fw.h>
11682cd038dSYoshinobu Inoue 
11733841545SHajimu UMEMOTO #include <net/net_osdep.h>
11833841545SHajimu UMEMOTO 
1191469c434SHajimu UMEMOTO #include <netinet6/ip6protosw.h>
1201469c434SHajimu UMEMOTO 
12182cd038dSYoshinobu Inoue static MALLOC_DEFINE(M_IPMOPTS, "ip6_moptions", "internet multicast options");
12282cd038dSYoshinobu Inoue 
12382cd038dSYoshinobu Inoue struct ip6_exthdrs {
12482cd038dSYoshinobu Inoue 	struct mbuf *ip6e_ip6;
12582cd038dSYoshinobu Inoue 	struct mbuf *ip6e_hbh;
12682cd038dSYoshinobu Inoue 	struct mbuf *ip6e_dest1;
12782cd038dSYoshinobu Inoue 	struct mbuf *ip6e_rthdr;
12882cd038dSYoshinobu Inoue 	struct mbuf *ip6e_dest2;
12982cd038dSYoshinobu Inoue };
13082cd038dSYoshinobu Inoue 
131f95d4633SHajimu UMEMOTO static int ip6_pcbopt __P((int, u_char *, int, struct ip6_pktopts **,
132f95d4633SHajimu UMEMOTO 			   int, int));
13382cd038dSYoshinobu Inoue static int ip6_pcbopts __P((struct ip6_pktopts **, struct mbuf *,
1347efe5d92SHajimu UMEMOTO 	struct socket *, struct sockopt *));
135f95d4633SHajimu UMEMOTO static int ip6_getpcbopt __P((struct ip6_pktopts *, int, struct sockopt *));
136f95d4633SHajimu UMEMOTO static int ip6_setpktoption __P((int, u_char *, int, struct ip6_pktopts *, int,
137f95d4633SHajimu UMEMOTO 	int, int, int));
138f95d4633SHajimu UMEMOTO 
13982cd038dSYoshinobu Inoue static int ip6_setmoptions __P((int, struct ip6_moptions **, struct mbuf *));
14082cd038dSYoshinobu Inoue static int ip6_getmoptions __P((int, struct ip6_moptions *, struct mbuf **));
14182cd038dSYoshinobu Inoue static int ip6_copyexthdr __P((struct mbuf **, caddr_t, int));
14282cd038dSYoshinobu Inoue static int ip6_insertfraghdr __P((struct mbuf *, struct mbuf *, int,
14382cd038dSYoshinobu Inoue 	struct ip6_frag **));
14482cd038dSYoshinobu Inoue static int ip6_insert_jumboopt __P((struct ip6_exthdrs *, u_int32_t));
14582cd038dSYoshinobu Inoue static int ip6_splithdr __P((struct mbuf *, struct ip6_exthdrs *));
14631b3783cSHajimu UMEMOTO static int ip6_getpmtu __P((struct route_in6 *, struct route_in6 *,
147f95d4633SHajimu UMEMOTO 	struct ifnet *, struct in6_addr *, u_long *, int *));
14882cd038dSYoshinobu Inoue 
1497efe5d92SHajimu UMEMOTO 
15082cd038dSYoshinobu Inoue /*
15182cd038dSYoshinobu Inoue  * IP6 output. The packet in mbuf chain m contains a skeletal IP6
15282cd038dSYoshinobu Inoue  * header (with pri, len, nxt, hlim, src, dst).
15382cd038dSYoshinobu Inoue  * This function may modify ver and hlim only.
15482cd038dSYoshinobu Inoue  * The mbuf chain containing the packet will be freed.
15582cd038dSYoshinobu Inoue  * The mbuf opt, if present, will not be freed.
15633841545SHajimu UMEMOTO  *
15733841545SHajimu UMEMOTO  * type of "mtu": rt_rmx.rmx_mtu is u_long, ifnet.ifr_mtu is int, and
15833841545SHajimu UMEMOTO  * nd_ifinfo.linkmtu is u_int32_t.  so we use u_long to hold largest one,
15933841545SHajimu UMEMOTO  * which is rt_rmx.rmx_mtu.
16082cd038dSYoshinobu Inoue  */
16182cd038dSYoshinobu Inoue int
1625d846453SSam Leffler ip6_output(m0, opt, ro, flags, im6o, ifpp, inp)
16382cd038dSYoshinobu Inoue 	struct mbuf *m0;
16482cd038dSYoshinobu Inoue 	struct ip6_pktopts *opt;
16582cd038dSYoshinobu Inoue 	struct route_in6 *ro;
16682cd038dSYoshinobu Inoue 	int flags;
16782cd038dSYoshinobu Inoue 	struct ip6_moptions *im6o;
16882cd038dSYoshinobu Inoue 	struct ifnet **ifpp;		/* XXX: just for statistics */
1695d846453SSam Leffler 	struct inpcb *inp;
17082cd038dSYoshinobu Inoue {
17182cd038dSYoshinobu Inoue 	struct ip6_hdr *ip6, *mhip6;
172686cdd19SJun-ichiro itojun Hagino 	struct ifnet *ifp, *origifp;
17382cd038dSYoshinobu Inoue 	struct mbuf *m = m0;
17482cd038dSYoshinobu Inoue 	int hlen, tlen, len, off;
17582cd038dSYoshinobu Inoue 	struct route_in6 ip6route;
17682cd038dSYoshinobu Inoue 	struct sockaddr_in6 *dst;
17782cd038dSYoshinobu Inoue 	int error = 0;
1785da9f8faSJosef Karthauser 	struct in6_ifaddr *ia = NULL;
17982cd038dSYoshinobu Inoue 	u_long mtu;
180f95d4633SHajimu UMEMOTO 	int alwaysfrag, dontfrag;
18182cd038dSYoshinobu Inoue 	u_int32_t optlen = 0, plen = 0, unfragpartlen = 0;
18282cd038dSYoshinobu Inoue 	struct ip6_exthdrs exthdrs;
18382cd038dSYoshinobu Inoue 	struct in6_addr finaldst;
18482cd038dSYoshinobu Inoue 	struct route_in6 *ro_pmtu = NULL;
18582cd038dSYoshinobu Inoue 	int hdrsplit = 0;
18682cd038dSYoshinobu Inoue 	int needipsec = 0;
18782cd038dSYoshinobu Inoue #ifdef IPSEC
18882cd038dSYoshinobu Inoue 	int needipsectun = 0;
18982cd038dSYoshinobu Inoue 	struct secpolicy *sp = NULL;
19082cd038dSYoshinobu Inoue 
19182cd038dSYoshinobu Inoue 	ip6 = mtod(m, struct ip6_hdr *);
19282cd038dSYoshinobu Inoue #endif /* IPSEC */
193b9234fafSSam Leffler #ifdef FAST_IPSEC
194b9234fafSSam Leffler 	int needipsectun = 0;
195b9234fafSSam Leffler 	struct secpolicy *sp = NULL;
196b9234fafSSam Leffler 
197b9234fafSSam Leffler 	ip6 = mtod(m, struct ip6_hdr *);
198b9234fafSSam Leffler #endif /* FAST_IPSEC */
19982cd038dSYoshinobu Inoue 
20082cd038dSYoshinobu Inoue #define MAKE_EXTHDR(hp, mp)						\
201686cdd19SJun-ichiro itojun Hagino     do {								\
20282cd038dSYoshinobu Inoue 	if (hp) {							\
20382cd038dSYoshinobu Inoue 		struct ip6_ext *eh = (struct ip6_ext *)(hp);		\
20482cd038dSYoshinobu Inoue 		error = ip6_copyexthdr((mp), (caddr_t)(hp),		\
20582cd038dSYoshinobu Inoue 		    ((eh)->ip6e_len + 1) << 3);				\
20682cd038dSYoshinobu Inoue 		if (error)						\
20782cd038dSYoshinobu Inoue 			goto freehdrs;					\
20882cd038dSYoshinobu Inoue 	}								\
2097efe5d92SHajimu UMEMOTO     } while (/*CONSTCOND*/ 0)
21082cd038dSYoshinobu Inoue 
21182cd038dSYoshinobu Inoue 	bzero(&exthdrs, sizeof(exthdrs));
212686cdd19SJun-ichiro itojun Hagino 
21382cd038dSYoshinobu Inoue 	if (opt) {
21482cd038dSYoshinobu Inoue 		/* Hop-by-Hop options header */
21582cd038dSYoshinobu Inoue 		MAKE_EXTHDR(opt->ip6po_hbh, &exthdrs.ip6e_hbh);
21682cd038dSYoshinobu Inoue 		/* Destination options header(1st part) */
21782cd038dSYoshinobu Inoue 		MAKE_EXTHDR(opt->ip6po_dest1, &exthdrs.ip6e_dest1);
21882cd038dSYoshinobu Inoue 		/* Routing header */
21982cd038dSYoshinobu Inoue 		MAKE_EXTHDR(opt->ip6po_rthdr, &exthdrs.ip6e_rthdr);
22082cd038dSYoshinobu Inoue 		/* Destination options header(2nd part) */
22182cd038dSYoshinobu Inoue 		MAKE_EXTHDR(opt->ip6po_dest2, &exthdrs.ip6e_dest2);
22282cd038dSYoshinobu Inoue 	}
22382cd038dSYoshinobu Inoue 
22482cd038dSYoshinobu Inoue #ifdef IPSEC
22582cd038dSYoshinobu Inoue 	/* get a security policy for this packet */
226340c35deSJonathan Lemon 	if (inp == NULL)
22782cd038dSYoshinobu Inoue 		sp = ipsec6_getpolicybyaddr(m, IPSEC_DIR_OUTBOUND, 0, &error);
22882cd038dSYoshinobu Inoue 	else
229340c35deSJonathan Lemon 		sp = ipsec6_getpolicybypcb(m, IPSEC_DIR_OUTBOUND, inp, &error);
23082cd038dSYoshinobu Inoue 
23182cd038dSYoshinobu Inoue 	if (sp == NULL) {
23282cd038dSYoshinobu Inoue 		ipsec6stat.out_inval++;
233686cdd19SJun-ichiro itojun Hagino 		goto freehdrs;
23482cd038dSYoshinobu Inoue 	}
23582cd038dSYoshinobu Inoue 
23682cd038dSYoshinobu Inoue 	error = 0;
23782cd038dSYoshinobu Inoue 
23882cd038dSYoshinobu Inoue 	/* check policy */
23982cd038dSYoshinobu Inoue 	switch (sp->policy) {
24082cd038dSYoshinobu Inoue 	case IPSEC_POLICY_DISCARD:
24182cd038dSYoshinobu Inoue 		/*
24282cd038dSYoshinobu Inoue 		 * This packet is just discarded.
24382cd038dSYoshinobu Inoue 		 */
24482cd038dSYoshinobu Inoue 		ipsec6stat.out_polvio++;
245686cdd19SJun-ichiro itojun Hagino 		goto freehdrs;
24682cd038dSYoshinobu Inoue 
24782cd038dSYoshinobu Inoue 	case IPSEC_POLICY_BYPASS:
24882cd038dSYoshinobu Inoue 	case IPSEC_POLICY_NONE:
24982cd038dSYoshinobu Inoue 		/* no need to do IPsec. */
25082cd038dSYoshinobu Inoue 		needipsec = 0;
25182cd038dSYoshinobu Inoue 		break;
25282cd038dSYoshinobu Inoue 
25382cd038dSYoshinobu Inoue 	case IPSEC_POLICY_IPSEC:
25482cd038dSYoshinobu Inoue 		if (sp->req == NULL) {
255686cdd19SJun-ichiro itojun Hagino 			/* acquire a policy */
256686cdd19SJun-ichiro itojun Hagino 			error = key_spdacquire(sp);
257686cdd19SJun-ichiro itojun Hagino 			goto freehdrs;
25882cd038dSYoshinobu Inoue 		}
25982cd038dSYoshinobu Inoue 		needipsec = 1;
26082cd038dSYoshinobu Inoue 		break;
26182cd038dSYoshinobu Inoue 
26282cd038dSYoshinobu Inoue 	case IPSEC_POLICY_ENTRUST:
26382cd038dSYoshinobu Inoue 	default:
26482cd038dSYoshinobu Inoue 		printf("ip6_output: Invalid policy found. %d\n", sp->policy);
26582cd038dSYoshinobu Inoue 	}
26682cd038dSYoshinobu Inoue #endif /* IPSEC */
267b9234fafSSam Leffler #ifdef FAST_IPSEC
268b9234fafSSam Leffler 	/* get a security policy for this packet */
269b9234fafSSam Leffler 	if (inp == NULL)
270b9234fafSSam Leffler 		sp = ipsec_getpolicybyaddr(m, IPSEC_DIR_OUTBOUND, 0, &error);
271b9234fafSSam Leffler 	else
272b9234fafSSam Leffler 		sp = ipsec_getpolicybysock(m, IPSEC_DIR_OUTBOUND, inp, &error);
273b9234fafSSam Leffler 
274b9234fafSSam Leffler 	if (sp == NULL) {
275b9234fafSSam Leffler 		newipsecstat.ips_out_inval++;
276b9234fafSSam Leffler 		goto freehdrs;
277b9234fafSSam Leffler 	}
278b9234fafSSam Leffler 
279b9234fafSSam Leffler 	error = 0;
280b9234fafSSam Leffler 
281b9234fafSSam Leffler 	/* check policy */
282b9234fafSSam Leffler 	switch (sp->policy) {
283b9234fafSSam Leffler 	case IPSEC_POLICY_DISCARD:
284b9234fafSSam Leffler 		/*
285b9234fafSSam Leffler 		 * This packet is just discarded.
286b9234fafSSam Leffler 		 */
287b9234fafSSam Leffler 		newipsecstat.ips_out_polvio++;
288b9234fafSSam Leffler 		goto freehdrs;
289b9234fafSSam Leffler 
290b9234fafSSam Leffler 	case IPSEC_POLICY_BYPASS:
291b9234fafSSam Leffler 	case IPSEC_POLICY_NONE:
292b9234fafSSam Leffler 		/* no need to do IPsec. */
293b9234fafSSam Leffler 		needipsec = 0;
294b9234fafSSam Leffler 		break;
295b9234fafSSam Leffler 
296b9234fafSSam Leffler 	case IPSEC_POLICY_IPSEC:
297b9234fafSSam Leffler 		if (sp->req == NULL) {
298b9234fafSSam Leffler 			/* acquire a policy */
299b9234fafSSam Leffler 			error = key_spdacquire(sp);
300b9234fafSSam Leffler 			goto freehdrs;
301b9234fafSSam Leffler 		}
302b9234fafSSam Leffler 		needipsec = 1;
303b9234fafSSam Leffler 		break;
304b9234fafSSam Leffler 
305b9234fafSSam Leffler 	case IPSEC_POLICY_ENTRUST:
306b9234fafSSam Leffler 	default:
307b9234fafSSam Leffler 		printf("ip6_output: Invalid policy found. %d\n", sp->policy);
308b9234fafSSam Leffler 	}
309b9234fafSSam Leffler #endif /* FAST_IPSEC */
31082cd038dSYoshinobu Inoue 
31182cd038dSYoshinobu Inoue 	/*
31282cd038dSYoshinobu Inoue 	 * Calculate the total length of the extension header chain.
31382cd038dSYoshinobu Inoue 	 * Keep the length of the unfragmentable part for fragmentation.
31482cd038dSYoshinobu Inoue 	 */
31582cd038dSYoshinobu Inoue 	optlen = 0;
31682cd038dSYoshinobu Inoue 	if (exthdrs.ip6e_hbh) optlen += exthdrs.ip6e_hbh->m_len;
31782cd038dSYoshinobu Inoue 	if (exthdrs.ip6e_dest1) optlen += exthdrs.ip6e_dest1->m_len;
31882cd038dSYoshinobu Inoue 	if (exthdrs.ip6e_rthdr) optlen += exthdrs.ip6e_rthdr->m_len;
31982cd038dSYoshinobu Inoue 	unfragpartlen = optlen + sizeof(struct ip6_hdr);
32082cd038dSYoshinobu Inoue 	/* NOTE: we don't add AH/ESP length here. do that later. */
32182cd038dSYoshinobu Inoue 	if (exthdrs.ip6e_dest2) optlen += exthdrs.ip6e_dest2->m_len;
32282cd038dSYoshinobu Inoue 
32382cd038dSYoshinobu Inoue 	/*
32482cd038dSYoshinobu Inoue 	 * If we need IPsec, or there is at least one extension header,
32582cd038dSYoshinobu Inoue 	 * separate IP6 header from the payload.
32682cd038dSYoshinobu Inoue 	 */
32782cd038dSYoshinobu Inoue 	if ((needipsec || optlen) && !hdrsplit) {
32882cd038dSYoshinobu Inoue 		if ((error = ip6_splithdr(m, &exthdrs)) != 0) {
32982cd038dSYoshinobu Inoue 			m = NULL;
33082cd038dSYoshinobu Inoue 			goto freehdrs;
33182cd038dSYoshinobu Inoue 		}
33282cd038dSYoshinobu Inoue 		m = exthdrs.ip6e_ip6;
33382cd038dSYoshinobu Inoue 		hdrsplit++;
33482cd038dSYoshinobu Inoue 	}
33582cd038dSYoshinobu Inoue 
33682cd038dSYoshinobu Inoue 	/* adjust pointer */
33782cd038dSYoshinobu Inoue 	ip6 = mtod(m, struct ip6_hdr *);
33882cd038dSYoshinobu Inoue 
33982cd038dSYoshinobu Inoue 	/* adjust mbuf packet header length */
34082cd038dSYoshinobu Inoue 	m->m_pkthdr.len += optlen;
34182cd038dSYoshinobu Inoue 	plen = m->m_pkthdr.len - sizeof(*ip6);
34282cd038dSYoshinobu Inoue 
34382cd038dSYoshinobu Inoue 	/* If this is a jumbo payload, insert a jumbo payload option. */
34482cd038dSYoshinobu Inoue 	if (plen > IPV6_MAXPACKET) {
34582cd038dSYoshinobu Inoue 		if (!hdrsplit) {
34682cd038dSYoshinobu Inoue 			if ((error = ip6_splithdr(m, &exthdrs)) != 0) {
34782cd038dSYoshinobu Inoue 				m = NULL;
34882cd038dSYoshinobu Inoue 				goto freehdrs;
34982cd038dSYoshinobu Inoue 			}
35082cd038dSYoshinobu Inoue 			m = exthdrs.ip6e_ip6;
35182cd038dSYoshinobu Inoue 			hdrsplit++;
35282cd038dSYoshinobu Inoue 		}
35382cd038dSYoshinobu Inoue 		/* adjust pointer */
35482cd038dSYoshinobu Inoue 		ip6 = mtod(m, struct ip6_hdr *);
35582cd038dSYoshinobu Inoue 		if ((error = ip6_insert_jumboopt(&exthdrs, plen)) != 0)
35682cd038dSYoshinobu Inoue 			goto freehdrs;
35782cd038dSYoshinobu Inoue 		ip6->ip6_plen = 0;
35882cd038dSYoshinobu Inoue 	} else
35982cd038dSYoshinobu Inoue 		ip6->ip6_plen = htons(plen);
36082cd038dSYoshinobu Inoue 
36182cd038dSYoshinobu Inoue 	/*
36282cd038dSYoshinobu Inoue 	 * Concatenate headers and fill in next header fields.
36382cd038dSYoshinobu Inoue 	 * Here we have, on "m"
36482cd038dSYoshinobu Inoue 	 *	IPv6 payload
36582cd038dSYoshinobu Inoue 	 * and we insert headers accordingly.  Finally, we should be getting:
36682cd038dSYoshinobu Inoue 	 *	IPv6 hbh dest1 rthdr ah* [esp* dest2 payload]
36782cd038dSYoshinobu Inoue 	 *
36882cd038dSYoshinobu Inoue 	 * during the header composing process, "m" points to IPv6 header.
36982cd038dSYoshinobu Inoue 	 * "mprev" points to an extension header prior to esp.
37082cd038dSYoshinobu Inoue 	 */
37182cd038dSYoshinobu Inoue 	{
37282cd038dSYoshinobu Inoue 		u_char *nexthdrp = &ip6->ip6_nxt;
37382cd038dSYoshinobu Inoue 		struct mbuf *mprev = m;
37482cd038dSYoshinobu Inoue 
37582cd038dSYoshinobu Inoue 		/*
37682cd038dSYoshinobu Inoue 		 * we treat dest2 specially.  this makes IPsec processing
37788ff5695SSUZUKI Shinsuke 		 * much easier.  the goal here is to make mprev point the
37888ff5695SSUZUKI Shinsuke 		 * mbuf prior to dest2.
37982cd038dSYoshinobu Inoue 		 *
38082cd038dSYoshinobu Inoue 		 * result: IPv6 dest2 payload
38182cd038dSYoshinobu Inoue 		 * m and mprev will point to IPv6 header.
38282cd038dSYoshinobu Inoue 		 */
38382cd038dSYoshinobu Inoue 		if (exthdrs.ip6e_dest2) {
38482cd038dSYoshinobu Inoue 			if (!hdrsplit)
38582cd038dSYoshinobu Inoue 				panic("assumption failed: hdr not split");
38682cd038dSYoshinobu Inoue 			exthdrs.ip6e_dest2->m_next = m->m_next;
38782cd038dSYoshinobu Inoue 			m->m_next = exthdrs.ip6e_dest2;
38882cd038dSYoshinobu Inoue 			*mtod(exthdrs.ip6e_dest2, u_char *) = ip6->ip6_nxt;
38982cd038dSYoshinobu Inoue 			ip6->ip6_nxt = IPPROTO_DSTOPTS;
39082cd038dSYoshinobu Inoue 		}
39182cd038dSYoshinobu Inoue 
39282cd038dSYoshinobu Inoue #define MAKE_CHAIN(m, mp, p, i)\
393686cdd19SJun-ichiro itojun Hagino     do {\
39482cd038dSYoshinobu Inoue 	if (m) {\
39582cd038dSYoshinobu Inoue 		if (!hdrsplit) \
39682cd038dSYoshinobu Inoue 			panic("assumption failed: hdr not split"); \
39782cd038dSYoshinobu Inoue 		*mtod((m), u_char *) = *(p);\
39882cd038dSYoshinobu Inoue 		*(p) = (i);\
39982cd038dSYoshinobu Inoue 		p = mtod((m), u_char *);\
40082cd038dSYoshinobu Inoue 		(m)->m_next = (mp)->m_next;\
40182cd038dSYoshinobu Inoue 		(mp)->m_next = (m);\
40282cd038dSYoshinobu Inoue 		(mp) = (m);\
40382cd038dSYoshinobu Inoue 	}\
4047efe5d92SHajimu UMEMOTO     } while (/*CONSTCOND*/ 0)
40582cd038dSYoshinobu Inoue 		/*
40682cd038dSYoshinobu Inoue 		 * result: IPv6 hbh dest1 rthdr dest2 payload
40782cd038dSYoshinobu Inoue 		 * m will point to IPv6 header.  mprev will point to the
40882cd038dSYoshinobu Inoue 		 * extension header prior to dest2 (rthdr in the above case).
40982cd038dSYoshinobu Inoue 		 */
4107efe5d92SHajimu UMEMOTO 		MAKE_CHAIN(exthdrs.ip6e_hbh, mprev, nexthdrp, IPPROTO_HOPOPTS);
4117efe5d92SHajimu UMEMOTO 		MAKE_CHAIN(exthdrs.ip6e_dest1, mprev, nexthdrp,
4127efe5d92SHajimu UMEMOTO 		    IPPROTO_DSTOPTS);
4137efe5d92SHajimu UMEMOTO 		MAKE_CHAIN(exthdrs.ip6e_rthdr, mprev, nexthdrp,
4147efe5d92SHajimu UMEMOTO 		    IPPROTO_ROUTING);
41582cd038dSYoshinobu Inoue 
416b9234fafSSam Leffler #if defined(IPSEC) || defined(FAST_IPSEC)
41782cd038dSYoshinobu Inoue 		if (!needipsec)
41882cd038dSYoshinobu Inoue 			goto skip_ipsec2;
41982cd038dSYoshinobu Inoue 
42082cd038dSYoshinobu Inoue 		/*
42182cd038dSYoshinobu Inoue 		 * pointers after IPsec headers are not valid any more.
42282cd038dSYoshinobu Inoue 		 * other pointers need a great care too.
42382cd038dSYoshinobu Inoue 		 * (IPsec routines should not mangle mbufs prior to AH/ESP)
42482cd038dSYoshinobu Inoue 		 */
42582cd038dSYoshinobu Inoue 		exthdrs.ip6e_dest2 = NULL;
42682cd038dSYoshinobu Inoue 
42782cd038dSYoshinobu Inoue 	    {
42882cd038dSYoshinobu Inoue 		struct ip6_rthdr *rh = NULL;
42982cd038dSYoshinobu Inoue 		int segleft_org = 0;
43082cd038dSYoshinobu Inoue 		struct ipsec_output_state state;
43182cd038dSYoshinobu Inoue 
43282cd038dSYoshinobu Inoue 		if (exthdrs.ip6e_rthdr) {
43382cd038dSYoshinobu Inoue 			rh = mtod(exthdrs.ip6e_rthdr, struct ip6_rthdr *);
43482cd038dSYoshinobu Inoue 			segleft_org = rh->ip6r_segleft;
43582cd038dSYoshinobu Inoue 			rh->ip6r_segleft = 0;
43682cd038dSYoshinobu Inoue 		}
43782cd038dSYoshinobu Inoue 
43882cd038dSYoshinobu Inoue 		bzero(&state, sizeof(state));
43982cd038dSYoshinobu Inoue 		state.m = m;
44082cd038dSYoshinobu Inoue 		error = ipsec6_output_trans(&state, nexthdrp, mprev, sp, flags,
44182cd038dSYoshinobu Inoue 		    &needipsectun);
44282cd038dSYoshinobu Inoue 		m = state.m;
44382cd038dSYoshinobu Inoue 		if (error) {
44482cd038dSYoshinobu Inoue 			/* mbuf is already reclaimed in ipsec6_output_trans. */
44582cd038dSYoshinobu Inoue 			m = NULL;
44682cd038dSYoshinobu Inoue 			switch (error) {
44782cd038dSYoshinobu Inoue 			case EHOSTUNREACH:
44882cd038dSYoshinobu Inoue 			case ENETUNREACH:
44982cd038dSYoshinobu Inoue 			case EMSGSIZE:
45082cd038dSYoshinobu Inoue 			case ENOBUFS:
45182cd038dSYoshinobu Inoue 			case ENOMEM:
45282cd038dSYoshinobu Inoue 				break;
45382cd038dSYoshinobu Inoue 			default:
45482cd038dSYoshinobu Inoue 				printf("ip6_output (ipsec): error code %d\n", error);
4557efe5d92SHajimu UMEMOTO 				/* FALLTHROUGH */
45682cd038dSYoshinobu Inoue 			case ENOENT:
45782cd038dSYoshinobu Inoue 				/* don't show these error codes to the user */
45882cd038dSYoshinobu Inoue 				error = 0;
45982cd038dSYoshinobu Inoue 				break;
46082cd038dSYoshinobu Inoue 			}
46182cd038dSYoshinobu Inoue 			goto bad;
46282cd038dSYoshinobu Inoue 		}
46382cd038dSYoshinobu Inoue 		if (exthdrs.ip6e_rthdr) {
46482cd038dSYoshinobu Inoue 			/* ah6_output doesn't modify mbuf chain */
46582cd038dSYoshinobu Inoue 			rh->ip6r_segleft = segleft_org;
46682cd038dSYoshinobu Inoue 		}
46782cd038dSYoshinobu Inoue 	    }
46882cd038dSYoshinobu Inoue skip_ipsec2:;
46982cd038dSYoshinobu Inoue #endif
47082cd038dSYoshinobu Inoue 	}
47182cd038dSYoshinobu Inoue 
47282cd038dSYoshinobu Inoue 	/*
4737efe5d92SHajimu UMEMOTO 	 * If there is a routing header, replace the destination address field
47482cd038dSYoshinobu Inoue 	 * with the first hop of the routing header.
47582cd038dSYoshinobu Inoue 	 */
47682cd038dSYoshinobu Inoue 	if (exthdrs.ip6e_rthdr) {
47782cd038dSYoshinobu Inoue 		struct ip6_rthdr *rh =
47882cd038dSYoshinobu Inoue 			(struct ip6_rthdr *)(mtod(exthdrs.ip6e_rthdr,
47982cd038dSYoshinobu Inoue 						  struct ip6_rthdr *));
48082cd038dSYoshinobu Inoue 		struct ip6_rthdr0 *rh0;
481c302f5bcSHajimu UMEMOTO 		struct in6_addr *addrs;
48282cd038dSYoshinobu Inoue 
48382cd038dSYoshinobu Inoue 		finaldst = ip6->ip6_dst;
48482cd038dSYoshinobu Inoue 		switch (rh->ip6r_type) {
48582cd038dSYoshinobu Inoue 		case IPV6_RTHDR_TYPE_0:
48682cd038dSYoshinobu Inoue 			 rh0 = (struct ip6_rthdr0 *)rh;
487c302f5bcSHajimu UMEMOTO 			 addrs = (struct in6_addr *)(rh + 1);
488c302f5bcSHajimu UMEMOTO 
489c302f5bcSHajimu UMEMOTO 			 ip6->ip6_dst = *addrs;
490c302f5bcSHajimu UMEMOTO 			 bcopy((caddr_t)(addrs + 1), (caddr_t)addrs,
49182cd038dSYoshinobu Inoue 			       sizeof(struct in6_addr)*(rh0->ip6r0_segleft - 1)
49282cd038dSYoshinobu Inoue 				 );
493c302f5bcSHajimu UMEMOTO 			 *(addrs + rh0->ip6r0_segleft - 1) = finaldst;
49482cd038dSYoshinobu Inoue 			 break;
49582cd038dSYoshinobu Inoue 		default:	/* is it possible? */
49682cd038dSYoshinobu Inoue 			 error = EINVAL;
49782cd038dSYoshinobu Inoue 			 goto bad;
49882cd038dSYoshinobu Inoue 		}
49982cd038dSYoshinobu Inoue 	}
50082cd038dSYoshinobu Inoue 
50182cd038dSYoshinobu Inoue 	/* Source address validation */
50282cd038dSYoshinobu Inoue 	if (IN6_IS_ADDR_UNSPECIFIED(&ip6->ip6_src) &&
50382cd038dSYoshinobu Inoue 	    (flags & IPV6_DADOUTPUT) == 0) {
50482cd038dSYoshinobu Inoue 		error = EOPNOTSUPP;
50582cd038dSYoshinobu Inoue 		ip6stat.ip6s_badscope++;
50682cd038dSYoshinobu Inoue 		goto bad;
50782cd038dSYoshinobu Inoue 	}
50882cd038dSYoshinobu Inoue 	if (IN6_IS_ADDR_MULTICAST(&ip6->ip6_src)) {
50982cd038dSYoshinobu Inoue 		error = EOPNOTSUPP;
51082cd038dSYoshinobu Inoue 		ip6stat.ip6s_badscope++;
51182cd038dSYoshinobu Inoue 		goto bad;
51282cd038dSYoshinobu Inoue 	}
51382cd038dSYoshinobu Inoue 
51482cd038dSYoshinobu Inoue 	ip6stat.ip6s_localout++;
51582cd038dSYoshinobu Inoue 
51682cd038dSYoshinobu Inoue 	/*
51782cd038dSYoshinobu Inoue 	 * Route packet.
51882cd038dSYoshinobu Inoue 	 */
51982cd038dSYoshinobu Inoue 	if (ro == 0) {
52082cd038dSYoshinobu Inoue 		ro = &ip6route;
52182cd038dSYoshinobu Inoue 		bzero((caddr_t)ro, sizeof(*ro));
52282cd038dSYoshinobu Inoue 	}
52382cd038dSYoshinobu Inoue 	ro_pmtu = ro;
52482cd038dSYoshinobu Inoue 	if (opt && opt->ip6po_rthdr)
52582cd038dSYoshinobu Inoue 		ro = &opt->ip6po_route;
52682cd038dSYoshinobu Inoue 	dst = (struct sockaddr_in6 *)&ro->ro_dst;
5277efe5d92SHajimu UMEMOTO 
52882cd038dSYoshinobu Inoue 	/*
52982cd038dSYoshinobu Inoue 	 * If there is a cached route,
53082cd038dSYoshinobu Inoue 	 * check that it is to the same destination
53182cd038dSYoshinobu Inoue 	 * and is still up. If not, free it and try again.
53282cd038dSYoshinobu Inoue 	 */
53382cd038dSYoshinobu Inoue 	if (ro->ro_rt && ((ro->ro_rt->rt_flags & RTF_UP) == 0 ||
5341183d014SHajimu UMEMOTO 			 dst->sin6_family != AF_INET6 ||
53582cd038dSYoshinobu Inoue 			 !IN6_ARE_ADDR_EQUAL(&dst->sin6_addr, &ip6->ip6_dst))) {
53682cd038dSYoshinobu Inoue 		RTFREE(ro->ro_rt);
53782cd038dSYoshinobu Inoue 		ro->ro_rt = (struct rtentry *)0;
53882cd038dSYoshinobu Inoue 	}
53982cd038dSYoshinobu Inoue 	if (ro->ro_rt == 0) {
54082cd038dSYoshinobu Inoue 		bzero(dst, sizeof(*dst));
54182cd038dSYoshinobu Inoue 		dst->sin6_family = AF_INET6;
54282cd038dSYoshinobu Inoue 		dst->sin6_len = sizeof(struct sockaddr_in6);
54382cd038dSYoshinobu Inoue 		dst->sin6_addr = ip6->ip6_dst;
54482cd038dSYoshinobu Inoue 	}
545f95d4633SHajimu UMEMOTO 
546f95d4633SHajimu UMEMOTO  	/*
547f95d4633SHajimu UMEMOTO 	 * if specified, try to fill in the traffic class field.
548f95d4633SHajimu UMEMOTO 	 * do not override if a non-zero value is already set.
549f95d4633SHajimu UMEMOTO 	 * we check the diffserv field and the ecn field separately.
550f95d4633SHajimu UMEMOTO 	 */
551f95d4633SHajimu UMEMOTO 	if (opt && opt->ip6po_tclass >= 0) {
552f95d4633SHajimu UMEMOTO 		int mask = 0;
553f95d4633SHajimu UMEMOTO 
554f95d4633SHajimu UMEMOTO 		if ((ip6->ip6_flow & htonl(0xfc << 20)) == 0)
555f95d4633SHajimu UMEMOTO 			mask |= 0xfc;
556f95d4633SHajimu UMEMOTO 		if ((ip6->ip6_flow & htonl(0x03 << 20)) == 0)
557f95d4633SHajimu UMEMOTO 			mask |= 0x03;
558f95d4633SHajimu UMEMOTO 		if (mask != 0)
559f95d4633SHajimu UMEMOTO 			ip6->ip6_flow |= htonl((opt->ip6po_tclass & mask) << 20);
560f95d4633SHajimu UMEMOTO 	}
561f95d4633SHajimu UMEMOTO 
562f95d4633SHajimu UMEMOTO 	/* fill in or override the hop limit field, if necessary. */
563f95d4633SHajimu UMEMOTO 	if (opt && opt->ip6po_hlim != -1)
564f95d4633SHajimu UMEMOTO 		ip6->ip6_hlim = opt->ip6po_hlim & 0xff;
565f95d4633SHajimu UMEMOTO 	else if (IN6_IS_ADDR_MULTICAST(&ip6->ip6_dst)) {
566f95d4633SHajimu UMEMOTO 		if (im6o != NULL)
567f95d4633SHajimu UMEMOTO 			ip6->ip6_hlim = im6o->im6o_multicast_hlim;
568f95d4633SHajimu UMEMOTO 		else
569f95d4633SHajimu UMEMOTO 			ip6->ip6_hlim = ip6_defmcasthlim;
570f95d4633SHajimu UMEMOTO 	}
571f95d4633SHajimu UMEMOTO 
572b9234fafSSam Leffler #if defined(IPSEC) || defined(FAST_IPSEC)
57382cd038dSYoshinobu Inoue 	if (needipsec && needipsectun) {
57482cd038dSYoshinobu Inoue 		struct ipsec_output_state state;
57582cd038dSYoshinobu Inoue 
57682cd038dSYoshinobu Inoue 		/*
57782cd038dSYoshinobu Inoue 		 * All the extension headers will become inaccessible
57882cd038dSYoshinobu Inoue 		 * (since they can be encrypted).
57982cd038dSYoshinobu Inoue 		 * Don't panic, we need no more updates to extension headers
58082cd038dSYoshinobu Inoue 		 * on inner IPv6 packet (since they are now encapsulated).
58182cd038dSYoshinobu Inoue 		 *
58282cd038dSYoshinobu Inoue 		 * IPv6 [ESP|AH] IPv6 [extension headers] payload
58382cd038dSYoshinobu Inoue 		 */
58482cd038dSYoshinobu Inoue 		bzero(&exthdrs, sizeof(exthdrs));
58582cd038dSYoshinobu Inoue 		exthdrs.ip6e_ip6 = m;
58682cd038dSYoshinobu Inoue 
58782cd038dSYoshinobu Inoue 		bzero(&state, sizeof(state));
58882cd038dSYoshinobu Inoue 		state.m = m;
58982cd038dSYoshinobu Inoue 		state.ro = (struct route *)ro;
59082cd038dSYoshinobu Inoue 		state.dst = (struct sockaddr *)dst;
59182cd038dSYoshinobu Inoue 
59282cd038dSYoshinobu Inoue 		error = ipsec6_output_tunnel(&state, sp, flags);
59382cd038dSYoshinobu Inoue 
59482cd038dSYoshinobu Inoue 		m = state.m;
59582cd038dSYoshinobu Inoue 		ro = (struct route_in6 *)state.ro;
59682cd038dSYoshinobu Inoue 		dst = (struct sockaddr_in6 *)state.dst;
59782cd038dSYoshinobu Inoue 		if (error) {
59882cd038dSYoshinobu Inoue 			/* mbuf is already reclaimed in ipsec6_output_tunnel. */
59982cd038dSYoshinobu Inoue 			m0 = m = NULL;
60082cd038dSYoshinobu Inoue 			m = NULL;
60182cd038dSYoshinobu Inoue 			switch (error) {
60282cd038dSYoshinobu Inoue 			case EHOSTUNREACH:
60382cd038dSYoshinobu Inoue 			case ENETUNREACH:
60482cd038dSYoshinobu Inoue 			case EMSGSIZE:
60582cd038dSYoshinobu Inoue 			case ENOBUFS:
60682cd038dSYoshinobu Inoue 			case ENOMEM:
60782cd038dSYoshinobu Inoue 				break;
60882cd038dSYoshinobu Inoue 			default:
60982cd038dSYoshinobu Inoue 				printf("ip6_output (ipsec): error code %d\n", error);
6107efe5d92SHajimu UMEMOTO 				/* FALLTHROUGH */
61182cd038dSYoshinobu Inoue 			case ENOENT:
61282cd038dSYoshinobu Inoue 				/* don't show these error codes to the user */
61382cd038dSYoshinobu Inoue 				error = 0;
61482cd038dSYoshinobu Inoue 				break;
61582cd038dSYoshinobu Inoue 			}
61682cd038dSYoshinobu Inoue 			goto bad;
61782cd038dSYoshinobu Inoue 		}
61882cd038dSYoshinobu Inoue 
61982cd038dSYoshinobu Inoue 		exthdrs.ip6e_ip6 = m;
62082cd038dSYoshinobu Inoue 	}
621686cdd19SJun-ichiro itojun Hagino #endif /* IPSEC */
62282cd038dSYoshinobu Inoue 
62382cd038dSYoshinobu Inoue 	if (!IN6_IS_ADDR_MULTICAST(&ip6->ip6_dst)) {
62482cd038dSYoshinobu Inoue 		/* Unicast */
62582cd038dSYoshinobu Inoue 
62682cd038dSYoshinobu Inoue #define ifatoia6(ifa)	((struct in6_ifaddr *)(ifa))
62782cd038dSYoshinobu Inoue #define sin6tosa(sin6)	((struct sockaddr *)(sin6))
62882cd038dSYoshinobu Inoue 		/* xxx
62982cd038dSYoshinobu Inoue 		 * interface selection comes here
63082cd038dSYoshinobu Inoue 		 * if an interface is specified from an upper layer,
63182cd038dSYoshinobu Inoue 		 * ifp must point it.
63282cd038dSYoshinobu Inoue 		 */
633686cdd19SJun-ichiro itojun Hagino 		if (ro->ro_rt == 0) {
634686cdd19SJun-ichiro itojun Hagino 			/*
635686cdd19SJun-ichiro itojun Hagino 			 * non-bsdi always clone routes, if parent is
636686cdd19SJun-ichiro itojun Hagino 			 * PRF_CLONING.
637686cdd19SJun-ichiro itojun Hagino 			 */
63882cd038dSYoshinobu Inoue 			rtalloc((struct route *)ro);
639686cdd19SJun-ichiro itojun Hagino 		}
64082cd038dSYoshinobu Inoue 		if (ro->ro_rt == 0) {
64182cd038dSYoshinobu Inoue 			ip6stat.ip6s_noroute++;
64282cd038dSYoshinobu Inoue 			error = EHOSTUNREACH;
64382cd038dSYoshinobu Inoue 			/* XXX in6_ifstat_inc(ifp, ifs6_out_discard); */
64482cd038dSYoshinobu Inoue 			goto bad;
64582cd038dSYoshinobu Inoue 		}
64668974f29SSam Leffler 		/* XXX rt not locked */
64782cd038dSYoshinobu Inoue 		ia = ifatoia6(ro->ro_rt->rt_ifa);
64882cd038dSYoshinobu Inoue 		ifp = ro->ro_rt->rt_ifp;
64982cd038dSYoshinobu Inoue 		ro->ro_rt->rt_use++;
65082cd038dSYoshinobu Inoue 		if (ro->ro_rt->rt_flags & RTF_GATEWAY)
65182cd038dSYoshinobu Inoue 			dst = (struct sockaddr_in6 *)ro->ro_rt->rt_gateway;
65282cd038dSYoshinobu Inoue 		m->m_flags &= ~(M_BCAST | M_MCAST);	/* just in case */
65382cd038dSYoshinobu Inoue 
65482cd038dSYoshinobu Inoue 		in6_ifstat_inc(ifp, ifs6_out_request);
65582cd038dSYoshinobu Inoue 
65682cd038dSYoshinobu Inoue 		/*
657686cdd19SJun-ichiro itojun Hagino 		 * Check if the outgoing interface conflicts with
65882cd038dSYoshinobu Inoue 		 * the interface specified by ifi6_ifindex (if specified).
65982cd038dSYoshinobu Inoue 		 * Note that loopback interface is always okay.
660686cdd19SJun-ichiro itojun Hagino 		 * (this may happen when we are sending a packet to one of
661686cdd19SJun-ichiro itojun Hagino 		 *  our own addresses.)
66282cd038dSYoshinobu Inoue 		 */
66382cd038dSYoshinobu Inoue 		if (opt && opt->ip6po_pktinfo
66482cd038dSYoshinobu Inoue 		 && opt->ip6po_pktinfo->ipi6_ifindex) {
66582cd038dSYoshinobu Inoue 			if (!(ifp->if_flags & IFF_LOOPBACK)
66682cd038dSYoshinobu Inoue 			 && ifp->if_index != opt->ip6po_pktinfo->ipi6_ifindex) {
66782cd038dSYoshinobu Inoue 				ip6stat.ip6s_noroute++;
66882cd038dSYoshinobu Inoue 				in6_ifstat_inc(ifp, ifs6_out_discard);
66982cd038dSYoshinobu Inoue 				error = EHOSTUNREACH;
67082cd038dSYoshinobu Inoue 				goto bad;
67182cd038dSYoshinobu Inoue 			}
67282cd038dSYoshinobu Inoue 		}
67382cd038dSYoshinobu Inoue 
67482cd038dSYoshinobu Inoue 		if (opt && opt->ip6po_hlim != -1)
67582cd038dSYoshinobu Inoue 			ip6->ip6_hlim = opt->ip6po_hlim & 0xff;
67682cd038dSYoshinobu Inoue 	} else {
67782cd038dSYoshinobu Inoue 		/* Multicast */
67882cd038dSYoshinobu Inoue 		struct	in6_multi *in6m;
67982cd038dSYoshinobu Inoue 
68082cd038dSYoshinobu Inoue 		m->m_flags = (m->m_flags & ~M_BCAST) | M_MCAST;
68182cd038dSYoshinobu Inoue 
68282cd038dSYoshinobu Inoue 		/*
68382cd038dSYoshinobu Inoue 		 * See if the caller provided any multicast options
68482cd038dSYoshinobu Inoue 		 */
68582cd038dSYoshinobu Inoue 		ifp = NULL;
68682cd038dSYoshinobu Inoue 		if (im6o != NULL) {
68782cd038dSYoshinobu Inoue 			ip6->ip6_hlim = im6o->im6o_multicast_hlim;
68882cd038dSYoshinobu Inoue 			if (im6o->im6o_multicast_ifp != NULL)
68982cd038dSYoshinobu Inoue 				ifp = im6o->im6o_multicast_ifp;
69082cd038dSYoshinobu Inoue 		} else
69182cd038dSYoshinobu Inoue 			ip6->ip6_hlim = ip6_defmcasthlim;
69282cd038dSYoshinobu Inoue 
69382cd038dSYoshinobu Inoue 		/*
69482cd038dSYoshinobu Inoue 		 * See if the caller provided the outgoing interface
69582cd038dSYoshinobu Inoue 		 * as an ancillary data.
69682cd038dSYoshinobu Inoue 		 * Boundary check for ifindex is assumed to be already done.
69782cd038dSYoshinobu Inoue 		 */
69882cd038dSYoshinobu Inoue 		if (opt && opt->ip6po_pktinfo && opt->ip6po_pktinfo->ipi6_ifindex)
699f9132cebSJonathan Lemon 			ifp = ifnet_byindex(opt->ip6po_pktinfo->ipi6_ifindex);
70082cd038dSYoshinobu Inoue 
70182cd038dSYoshinobu Inoue 		/*
70282cd038dSYoshinobu Inoue 		 * If the destination is a node-local scope multicast,
70382cd038dSYoshinobu Inoue 		 * the packet should be loop-backed only.
70482cd038dSYoshinobu Inoue 		 */
7059a4f9608SHajimu UMEMOTO 		if (IN6_IS_ADDR_MC_INTFACELOCAL(&ip6->ip6_dst)) {
70682cd038dSYoshinobu Inoue 			/*
70782cd038dSYoshinobu Inoue 			 * If the outgoing interface is already specified,
70882cd038dSYoshinobu Inoue 			 * it should be a loopback interface.
70982cd038dSYoshinobu Inoue 			 */
71082cd038dSYoshinobu Inoue 			if (ifp && (ifp->if_flags & IFF_LOOPBACK) == 0) {
71182cd038dSYoshinobu Inoue 				ip6stat.ip6s_badscope++;
71282cd038dSYoshinobu Inoue 				error = ENETUNREACH; /* XXX: better error? */
71382cd038dSYoshinobu Inoue 				/* XXX correct ifp? */
71482cd038dSYoshinobu Inoue 				in6_ifstat_inc(ifp, ifs6_out_discard);
71582cd038dSYoshinobu Inoue 				goto bad;
71682cd038dSYoshinobu Inoue 			} else {
71782cd038dSYoshinobu Inoue 				ifp = &loif[0];
71882cd038dSYoshinobu Inoue 			}
71982cd038dSYoshinobu Inoue 		}
72082cd038dSYoshinobu Inoue 
72182cd038dSYoshinobu Inoue 		if (opt && opt->ip6po_hlim != -1)
72282cd038dSYoshinobu Inoue 			ip6->ip6_hlim = opt->ip6po_hlim & 0xff;
72382cd038dSYoshinobu Inoue 
72482cd038dSYoshinobu Inoue 		/*
72582cd038dSYoshinobu Inoue 		 * If caller did not provide an interface lookup a
72682cd038dSYoshinobu Inoue 		 * default in the routing table.  This is either a
72782cd038dSYoshinobu Inoue 		 * default for the speicfied group (i.e. a host
72882cd038dSYoshinobu Inoue 		 * route), or a multicast default (a route for the
72982cd038dSYoshinobu Inoue 		 * ``net'' ff00::/8).
73082cd038dSYoshinobu Inoue 		 */
73182cd038dSYoshinobu Inoue 		if (ifp == NULL) {
73268974f29SSam Leffler 			if (ro->ro_rt == 0)
73382cd038dSYoshinobu Inoue 				ro->ro_rt = rtalloc1((struct sockaddr *)
73482cd038dSYoshinobu Inoue 						&ro->ro_dst, 0, 0UL);
73568974f29SSam Leffler 			else
73668974f29SSam Leffler 				RT_LOCK(ro->ro_rt);
73782cd038dSYoshinobu Inoue 			if (ro->ro_rt == 0) {
73882cd038dSYoshinobu Inoue 				ip6stat.ip6s_noroute++;
73982cd038dSYoshinobu Inoue 				error = EHOSTUNREACH;
74082cd038dSYoshinobu Inoue 				/* XXX in6_ifstat_inc(ifp, ifs6_out_discard) */
74182cd038dSYoshinobu Inoue 				goto bad;
74282cd038dSYoshinobu Inoue 			}
74382cd038dSYoshinobu Inoue 			ia = ifatoia6(ro->ro_rt->rt_ifa);
74482cd038dSYoshinobu Inoue 			ifp = ro->ro_rt->rt_ifp;
74582cd038dSYoshinobu Inoue 			ro->ro_rt->rt_use++;
746d1dd20beSSam Leffler 			RT_UNLOCK(ro->ro_rt);
74782cd038dSYoshinobu Inoue 		}
74882cd038dSYoshinobu Inoue 
74982cd038dSYoshinobu Inoue 		if ((flags & IPV6_FORWARDING) == 0)
75082cd038dSYoshinobu Inoue 			in6_ifstat_inc(ifp, ifs6_out_request);
75182cd038dSYoshinobu Inoue 		in6_ifstat_inc(ifp, ifs6_out_mcast);
75282cd038dSYoshinobu Inoue 
75382cd038dSYoshinobu Inoue 		/*
75482cd038dSYoshinobu Inoue 		 * Confirm that the outgoing interface supports multicast.
75582cd038dSYoshinobu Inoue 		 */
75682cd038dSYoshinobu Inoue 		if ((ifp->if_flags & IFF_MULTICAST) == 0) {
75782cd038dSYoshinobu Inoue 			ip6stat.ip6s_noroute++;
75882cd038dSYoshinobu Inoue 			in6_ifstat_inc(ifp, ifs6_out_discard);
75982cd038dSYoshinobu Inoue 			error = ENETUNREACH;
76082cd038dSYoshinobu Inoue 			goto bad;
76182cd038dSYoshinobu Inoue 		}
76282cd038dSYoshinobu Inoue 		IN6_LOOKUP_MULTI(ip6->ip6_dst, ifp, in6m);
76382cd038dSYoshinobu Inoue 		if (in6m != NULL &&
76482cd038dSYoshinobu Inoue 		   (im6o == NULL || im6o->im6o_multicast_loop)) {
76582cd038dSYoshinobu Inoue 			/*
76682cd038dSYoshinobu Inoue 			 * If we belong to the destination multicast group
76782cd038dSYoshinobu Inoue 			 * on the outgoing interface, and the caller did not
76882cd038dSYoshinobu Inoue 			 * forbid loopback, loop back a copy.
76982cd038dSYoshinobu Inoue 			 */
77082cd038dSYoshinobu Inoue 			ip6_mloopback(ifp, m, dst);
77191ec0a1eSYoshinobu Inoue 		} else {
77291ec0a1eSYoshinobu Inoue 			/*
77391ec0a1eSYoshinobu Inoue 			 * If we are acting as a multicast router, perform
77491ec0a1eSYoshinobu Inoue 			 * multicast forwarding as if the packet had just
77591ec0a1eSYoshinobu Inoue 			 * arrived on the interface to which we are about
77691ec0a1eSYoshinobu Inoue 			 * to send.  The multicast forwarding function
77791ec0a1eSYoshinobu Inoue 			 * recursively calls this function, using the
77891ec0a1eSYoshinobu Inoue 			 * IPV6_FORWARDING flag to prevent infinite recursion.
77991ec0a1eSYoshinobu Inoue 			 *
78091ec0a1eSYoshinobu Inoue 			 * Multicasts that are looped back by ip6_mloopback(),
78191ec0a1eSYoshinobu Inoue 			 * above, will be forwarded by the ip6_input() routine,
78291ec0a1eSYoshinobu Inoue 			 * if necessary.
78391ec0a1eSYoshinobu Inoue 			 */
78491ec0a1eSYoshinobu Inoue 			if (ip6_mrouter && (flags & IPV6_FORWARDING) == 0) {
785686cdd19SJun-ichiro itojun Hagino 				if (ip6_mforward(ip6, ifp, m) != 0) {
78691ec0a1eSYoshinobu Inoue 					m_freem(m);
78791ec0a1eSYoshinobu Inoue 					goto done;
78891ec0a1eSYoshinobu Inoue 				}
78991ec0a1eSYoshinobu Inoue 			}
79082cd038dSYoshinobu Inoue 		}
79182cd038dSYoshinobu Inoue 		/*
79282cd038dSYoshinobu Inoue 		 * Multicasts with a hoplimit of zero may be looped back,
79382cd038dSYoshinobu Inoue 		 * above, but must not be transmitted on a network.
79482cd038dSYoshinobu Inoue 		 * Also, multicasts addressed to the loopback interface
79582cd038dSYoshinobu Inoue 		 * are not sent -- the above call to ip6_mloopback() will
79682cd038dSYoshinobu Inoue 		 * loop back a copy if this host actually belongs to the
79782cd038dSYoshinobu Inoue 		 * destination group on the loopback interface.
79882cd038dSYoshinobu Inoue 		 */
799f95d4633SHajimu UMEMOTO 		if (ip6->ip6_hlim == 0 || (ifp->if_flags & IFF_LOOPBACK) ||
800f95d4633SHajimu UMEMOTO 		    IN6_IS_ADDR_MC_INTFACELOCAL(&ip6->ip6_dst)) {
80182cd038dSYoshinobu Inoue 			m_freem(m);
80282cd038dSYoshinobu Inoue 			goto done;
80382cd038dSYoshinobu Inoue 		}
80482cd038dSYoshinobu Inoue 	}
80582cd038dSYoshinobu Inoue 
80682cd038dSYoshinobu Inoue 	/*
80782cd038dSYoshinobu Inoue 	 * Fill the outgoing inteface to tell the upper layer
80882cd038dSYoshinobu Inoue 	 * to increment per-interface statistics.
80982cd038dSYoshinobu Inoue 	 */
81082cd038dSYoshinobu Inoue 	if (ifpp)
81182cd038dSYoshinobu Inoue 		*ifpp = ifp;
81282cd038dSYoshinobu Inoue 
81331b3783cSHajimu UMEMOTO 	/* Determine path MTU. */
814f95d4633SHajimu UMEMOTO 	if ((error = ip6_getpmtu(ro_pmtu, ro, ifp, &finaldst, &mtu,
815f95d4633SHajimu UMEMOTO 	    &alwaysfrag)) != 0)
81631b3783cSHajimu UMEMOTO 		goto bad;
81782cd038dSYoshinobu Inoue 
81833841545SHajimu UMEMOTO 	/*
81933841545SHajimu UMEMOTO 	 * advanced API (IPV6_USE_MIN_MTU) overrides mtu setting
82033841545SHajimu UMEMOTO 	 */
82133841545SHajimu UMEMOTO 	if ((flags & IPV6_MINMTU) != 0 && mtu > IPV6_MMTU)
82233841545SHajimu UMEMOTO 		mtu = IPV6_MMTU;
82333841545SHajimu UMEMOTO 
824686cdd19SJun-ichiro itojun Hagino 	/* Fake scoped addresses */
825686cdd19SJun-ichiro itojun Hagino 	if ((ifp->if_flags & IFF_LOOPBACK) != 0) {
82682cd038dSYoshinobu Inoue 		/*
827686cdd19SJun-ichiro itojun Hagino 		 * If source or destination address is a scoped address, and
828686cdd19SJun-ichiro itojun Hagino 		 * the packet is going to be sent to a loopback interface,
829686cdd19SJun-ichiro itojun Hagino 		 * we should keep the original interface.
83082cd038dSYoshinobu Inoue 		 */
831686cdd19SJun-ichiro itojun Hagino 
832686cdd19SJun-ichiro itojun Hagino 		/*
833686cdd19SJun-ichiro itojun Hagino 		 * XXX: this is a very experimental and temporary solution.
834686cdd19SJun-ichiro itojun Hagino 		 * We eventually have sockaddr_in6 and use the sin6_scope_id
835686cdd19SJun-ichiro itojun Hagino 		 * field of the structure here.
836686cdd19SJun-ichiro itojun Hagino 		 * We rely on the consistency between two scope zone ids
83788ff5695SSUZUKI Shinsuke 		 * of source and destination, which should already be assured.
83888ff5695SSUZUKI Shinsuke 		 * Larger scopes than link will be supported in the future.
839686cdd19SJun-ichiro itojun Hagino 		 */
84033841545SHajimu UMEMOTO 		origifp = NULL;
841686cdd19SJun-ichiro itojun Hagino 		if (IN6_IS_SCOPE_LINKLOCAL(&ip6->ip6_src))
842f9132cebSJonathan Lemon 			origifp = ifnet_byindex(ntohs(ip6->ip6_src.s6_addr16[1]));
843686cdd19SJun-ichiro itojun Hagino 		else if (IN6_IS_SCOPE_LINKLOCAL(&ip6->ip6_dst))
844f9132cebSJonathan Lemon 			origifp = ifnet_byindex(ntohs(ip6->ip6_dst.s6_addr16[1]));
84533841545SHajimu UMEMOTO 		/*
84633841545SHajimu UMEMOTO 		 * XXX: origifp can be NULL even in those two cases above.
84733841545SHajimu UMEMOTO 		 * For example, if we remove the (only) link-local address
84833841545SHajimu UMEMOTO 		 * from the loopback interface, and try to send a link-local
84933841545SHajimu UMEMOTO 		 * address without link-id information.  Then the source
85033841545SHajimu UMEMOTO 		 * address is ::1, and the destination address is the
85133841545SHajimu UMEMOTO 		 * link-local address with its s6_addr16[1] being zero.
85233841545SHajimu UMEMOTO 		 * What is worse, if the packet goes to the loopback interface
85333841545SHajimu UMEMOTO 		 * by a default rejected route, the null pointer would be
85433841545SHajimu UMEMOTO 		 * passed to looutput, and the kernel would hang.
85533841545SHajimu UMEMOTO 		 * The following last resort would prevent such disaster.
85633841545SHajimu UMEMOTO 		 */
85733841545SHajimu UMEMOTO 		if (origifp == NULL)
858686cdd19SJun-ichiro itojun Hagino 			origifp = ifp;
859686cdd19SJun-ichiro itojun Hagino 	}
860686cdd19SJun-ichiro itojun Hagino 	else
861686cdd19SJun-ichiro itojun Hagino 		origifp = ifp;
86233841545SHajimu UMEMOTO 	/*
86333841545SHajimu UMEMOTO 	 * clear embedded scope identifiers if necessary.
86433841545SHajimu UMEMOTO 	 * in6_clearscope will touch the addresses only when necessary.
86533841545SHajimu UMEMOTO 	 */
86633841545SHajimu UMEMOTO 	in6_clearscope(&ip6->ip6_src);
86733841545SHajimu UMEMOTO 	in6_clearscope(&ip6->ip6_dst);
86882cd038dSYoshinobu Inoue 
86982cd038dSYoshinobu Inoue 	/*
87082cd038dSYoshinobu Inoue 	 * Check with the firewall...
87182cd038dSYoshinobu Inoue 	 */
87220cb9f9eSHajimu UMEMOTO 	if (ip6_fw_enable && ip6_fw_chk_ptr) {
87382cd038dSYoshinobu Inoue 		u_short port = 0;
874686cdd19SJun-ichiro itojun Hagino 		m->m_pkthdr.rcvif = NULL;	/* XXX */
87582cd038dSYoshinobu Inoue 		/* If ipfw says divert, we have to just drop packet */
87682cd038dSYoshinobu Inoue 		if ((*ip6_fw_chk_ptr)(&ip6, ifp, &port, &m)) {
87782cd038dSYoshinobu Inoue 			m_freem(m);
87882cd038dSYoshinobu Inoue 			goto done;
87982cd038dSYoshinobu Inoue 		}
88082cd038dSYoshinobu Inoue 		if (!m) {
88182cd038dSYoshinobu Inoue 			error = EACCES;
88282cd038dSYoshinobu Inoue 			goto done;
88382cd038dSYoshinobu Inoue 		}
88482cd038dSYoshinobu Inoue 	}
88582cd038dSYoshinobu Inoue 
88682cd038dSYoshinobu Inoue 	/*
88782cd038dSYoshinobu Inoue 	 * If the outgoing packet contains a hop-by-hop options header,
88882cd038dSYoshinobu Inoue 	 * it must be examined and processed even by the source node.
88982cd038dSYoshinobu Inoue 	 * (RFC 2460, section 4.)
89082cd038dSYoshinobu Inoue 	 */
89182cd038dSYoshinobu Inoue 	if (exthdrs.ip6e_hbh) {
89233841545SHajimu UMEMOTO 		struct ip6_hbh *hbh = mtod(exthdrs.ip6e_hbh, struct ip6_hbh *);
89382cd038dSYoshinobu Inoue 		u_int32_t dummy1; /* XXX unused */
89482cd038dSYoshinobu Inoue 		u_int32_t dummy2; /* XXX unused */
89582cd038dSYoshinobu Inoue 
89633841545SHajimu UMEMOTO #ifdef DIAGNOSTIC
89733841545SHajimu UMEMOTO 		if ((hbh->ip6h_len + 1) << 3 > exthdrs.ip6e_hbh->m_len)
89833841545SHajimu UMEMOTO 			panic("ip6e_hbh is not continuous");
89933841545SHajimu UMEMOTO #endif
90082cd038dSYoshinobu Inoue 		/*
90182cd038dSYoshinobu Inoue 		 *  XXX: if we have to send an ICMPv6 error to the sender,
90282cd038dSYoshinobu Inoue 		 *       we need the M_LOOP flag since icmp6_error() expects
90382cd038dSYoshinobu Inoue 		 *       the IPv6 and the hop-by-hop options header are
90482cd038dSYoshinobu Inoue 		 *       continuous unless the flag is set.
90582cd038dSYoshinobu Inoue 		 */
90682cd038dSYoshinobu Inoue 		m->m_flags |= M_LOOP;
90782cd038dSYoshinobu Inoue 		m->m_pkthdr.rcvif = ifp;
9087efe5d92SHajimu UMEMOTO 		if (ip6_process_hopopts(m, (u_int8_t *)(hbh + 1),
9097efe5d92SHajimu UMEMOTO 		    ((hbh->ip6h_len + 1) << 3) - sizeof(struct ip6_hbh),
91082cd038dSYoshinobu Inoue 		    &dummy1, &dummy2) < 0) {
91182cd038dSYoshinobu Inoue 			/* m was already freed at this point */
91282cd038dSYoshinobu Inoue 			error = EINVAL;/* better error? */
91382cd038dSYoshinobu Inoue 			goto done;
91482cd038dSYoshinobu Inoue 		}
91582cd038dSYoshinobu Inoue 		m->m_flags &= ~M_LOOP; /* XXX */
91682cd038dSYoshinobu Inoue 		m->m_pkthdr.rcvif = NULL;
91782cd038dSYoshinobu Inoue 	}
91882cd038dSYoshinobu Inoue 
919c4ac87eaSDarren Reed #ifdef PFIL_HOOKS
920c4ac87eaSDarren Reed 	/*
921c4ac87eaSDarren Reed 	 * Run through list of hooks for output packets.
922c4ac87eaSDarren Reed 	 */
923b140bc1fSSam Leffler 	error = pfil_run_hooks(&inet6_pfil_hook, &m, ifp, PFIL_OUT);
924b140bc1fSSam Leffler 	if (error != 0 || m == NULL)
925c4ac87eaSDarren Reed 		goto done;
926c4ac87eaSDarren Reed 	ip6 = mtod(m, struct ip6_hdr *);
927c4ac87eaSDarren Reed #endif /* PFIL_HOOKS */
9287efe5d92SHajimu UMEMOTO 
92982cd038dSYoshinobu Inoue 	/*
93082cd038dSYoshinobu Inoue 	 * Send the packet to the outgoing interface.
93182cd038dSYoshinobu Inoue 	 * If necessary, do IPv6 fragmentation before sending.
932f95d4633SHajimu UMEMOTO 	 *
933f95d4633SHajimu UMEMOTO 	 * the logic here is rather complex:
934f95d4633SHajimu UMEMOTO 	 * 1: normal case (dontfrag == 0, alwaysfrag == 0)
935f95d4633SHajimu UMEMOTO 	 * 1-a:	send as is if tlen <= path mtu
936f95d4633SHajimu UMEMOTO 	 * 1-b:	fragment if tlen > path mtu
937f95d4633SHajimu UMEMOTO 	 *
938f95d4633SHajimu UMEMOTO 	 * 2: if user asks us not to fragment (dontfrag == 1)
939f95d4633SHajimu UMEMOTO 	 * 2-a:	send as is if tlen <= interface mtu
940f95d4633SHajimu UMEMOTO 	 * 2-b:	error if tlen > interface mtu
941f95d4633SHajimu UMEMOTO 	 *
942f95d4633SHajimu UMEMOTO 	 * 3: if we always need to attach fragment header (alwaysfrag == 1)
943f95d4633SHajimu UMEMOTO 	 *	always fragment
944f95d4633SHajimu UMEMOTO 	 *
945f95d4633SHajimu UMEMOTO 	 * 4: if dontfrag == 1 && alwaysfrag == 1
946f95d4633SHajimu UMEMOTO 	 *	error, as we cannot handle this conflicting request
94782cd038dSYoshinobu Inoue 	 */
94882cd038dSYoshinobu Inoue 	tlen = m->m_pkthdr.len;
94982cd038dSYoshinobu Inoue 
950f95d4633SHajimu UMEMOTO 	if (opt && (opt->ip6po_flags & IP6PO_DONTFRAG))
951f95d4633SHajimu UMEMOTO 		dontfrag = 1;
952f95d4633SHajimu UMEMOTO 	else
953f95d4633SHajimu UMEMOTO 		dontfrag = 0;
954f95d4633SHajimu UMEMOTO 	if (dontfrag && alwaysfrag) {	/* case 4 */
955f95d4633SHajimu UMEMOTO 		/* conflicting request - can't transmit */
956f95d4633SHajimu UMEMOTO 		error = EMSGSIZE;
957f95d4633SHajimu UMEMOTO 		goto bad;
958f95d4633SHajimu UMEMOTO 	}
959f95d4633SHajimu UMEMOTO 	if (dontfrag && tlen > IN6_LINKMTU(ifp)) {	/* case 2-b */
960f95d4633SHajimu UMEMOTO 		/*
961f95d4633SHajimu UMEMOTO 		 * Even if the DONTFRAG option is specified, we cannot send the
962f95d4633SHajimu UMEMOTO 		 * packet when the data length is larger than the MTU of the
963f95d4633SHajimu UMEMOTO 		 * outgoing interface.
964f95d4633SHajimu UMEMOTO 		 * Notify the error by sending IPV6_PATHMTU ancillary data as
965f95d4633SHajimu UMEMOTO 		 * well as returning an error code (the latter is not described
966f95d4633SHajimu UMEMOTO 		 * in the API spec.)
967f95d4633SHajimu UMEMOTO 		 */
968f95d4633SHajimu UMEMOTO 		u_int32_t mtu32;
969f95d4633SHajimu UMEMOTO 		struct ip6ctlparam ip6cp;
970f95d4633SHajimu UMEMOTO 
971f95d4633SHajimu UMEMOTO 		mtu32 = (u_int32_t)mtu;
972f95d4633SHajimu UMEMOTO 		bzero(&ip6cp, sizeof(ip6cp));
973f95d4633SHajimu UMEMOTO 		ip6cp.ip6c_cmdarg = (void *)&mtu32;
974f95d4633SHajimu UMEMOTO 		pfctlinput2(PRC_MSGSIZE, (struct sockaddr *)&ro_pmtu->ro_dst,
975f95d4633SHajimu UMEMOTO 		    (void *)&ip6cp);
976f95d4633SHajimu UMEMOTO 
977f95d4633SHajimu UMEMOTO 		error = EMSGSIZE;
978f95d4633SHajimu UMEMOTO 		goto bad;
979f95d4633SHajimu UMEMOTO 	}
980f95d4633SHajimu UMEMOTO 
981f95d4633SHajimu UMEMOTO 	/*
982f95d4633SHajimu UMEMOTO 	 * transmit packet without fragmentation
983f95d4633SHajimu UMEMOTO 	 */
984f95d4633SHajimu UMEMOTO 	if (dontfrag || (!alwaysfrag && tlen <= mtu)) {	/* case 1-a and 2-a */
985f95d4633SHajimu UMEMOTO 		struct in6_ifaddr *ia6;
986f95d4633SHajimu UMEMOTO 
987f95d4633SHajimu UMEMOTO 		ip6 = mtod(m, struct ip6_hdr *);
988f95d4633SHajimu UMEMOTO 		ia6 = in6_ifawithifp(ifp, &ip6->ip6_src);
989f95d4633SHajimu UMEMOTO 		if (ia6) {
9905da9f8faSJosef Karthauser 			/* Record statistics for this interface address. */
991f95d4633SHajimu UMEMOTO 			ia6->ia_ifa.if_opackets++;
992f95d4633SHajimu UMEMOTO 			ia6->ia_ifa.if_obytes += m->m_pkthdr.len;
9935da9f8faSJosef Karthauser 		}
99433841545SHajimu UMEMOTO #ifdef IPSEC
99533841545SHajimu UMEMOTO 		/* clean ipsec history once it goes out of the node */
99633841545SHajimu UMEMOTO 		ipsec_delaux(m);
99733841545SHajimu UMEMOTO #endif
998686cdd19SJun-ichiro itojun Hagino 		error = nd6_output(ifp, origifp, m, dst, ro->ro_rt);
99982cd038dSYoshinobu Inoue 		goto done;
1000f95d4633SHajimu UMEMOTO 	}
1001f95d4633SHajimu UMEMOTO 
100282cd038dSYoshinobu Inoue 	/*
1003f95d4633SHajimu UMEMOTO 	 * try to fragment the packet.  case 1-b and 3
100482cd038dSYoshinobu Inoue 	 */
1005f95d4633SHajimu UMEMOTO 	if (mtu < IPV6_MMTU) {
1006f95d4633SHajimu UMEMOTO 		/* path MTU cannot be less than IPV6_MMTU */
100782cd038dSYoshinobu Inoue 		error = EMSGSIZE;
100882cd038dSYoshinobu Inoue 		in6_ifstat_inc(ifp, ifs6_out_fragfail);
100982cd038dSYoshinobu Inoue 		goto bad;
10107efe5d92SHajimu UMEMOTO 	} else if (ip6->ip6_plen == 0) {
10117efe5d92SHajimu UMEMOTO 		/* jumbo payload cannot be fragmented */
101282cd038dSYoshinobu Inoue 		error = EMSGSIZE;
101382cd038dSYoshinobu Inoue 		in6_ifstat_inc(ifp, ifs6_out_fragfail);
101482cd038dSYoshinobu Inoue 		goto bad;
101582cd038dSYoshinobu Inoue 	} else {
101682cd038dSYoshinobu Inoue 		struct mbuf **mnext, *m_frgpart;
101782cd038dSYoshinobu Inoue 		struct ip6_frag *ip6f;
101829234943SHajimu UMEMOTO #ifdef RANDOM_IP_ID
10198373d51dSHajimu UMEMOTO 		u_int32_t id = htonl(ip6_randomid());
102029234943SHajimu UMEMOTO #else
102129234943SHajimu UMEMOTO 		u_int32_t id = htonl(ip6_id++);
102229234943SHajimu UMEMOTO #endif
102382cd038dSYoshinobu Inoue 		u_char nextproto;
102482cd038dSYoshinobu Inoue 
102582cd038dSYoshinobu Inoue 		/*
102682cd038dSYoshinobu Inoue 		 * Too large for the destination or interface;
102782cd038dSYoshinobu Inoue 		 * fragment if possible.
102882cd038dSYoshinobu Inoue 		 * Must be able to put at least 8 bytes per fragment.
102982cd038dSYoshinobu Inoue 		 */
103082cd038dSYoshinobu Inoue 		hlen = unfragpartlen;
103182cd038dSYoshinobu Inoue 		if (mtu > IPV6_MAXPACKET)
103282cd038dSYoshinobu Inoue 			mtu = IPV6_MAXPACKET;
103333841545SHajimu UMEMOTO 
103482cd038dSYoshinobu Inoue 		len = (mtu - hlen - sizeof(struct ip6_frag)) & ~7;
103582cd038dSYoshinobu Inoue 		if (len < 8) {
103682cd038dSYoshinobu Inoue 			error = EMSGSIZE;
103782cd038dSYoshinobu Inoue 			in6_ifstat_inc(ifp, ifs6_out_fragfail);
103882cd038dSYoshinobu Inoue 			goto bad;
103982cd038dSYoshinobu Inoue 		}
104082cd038dSYoshinobu Inoue 
104182cd038dSYoshinobu Inoue 		mnext = &m->m_nextpkt;
104282cd038dSYoshinobu Inoue 
104382cd038dSYoshinobu Inoue 		/*
104482cd038dSYoshinobu Inoue 		 * Change the next header field of the last header in the
104582cd038dSYoshinobu Inoue 		 * unfragmentable part.
104682cd038dSYoshinobu Inoue 		 */
104782cd038dSYoshinobu Inoue 		if (exthdrs.ip6e_rthdr) {
104882cd038dSYoshinobu Inoue 			nextproto = *mtod(exthdrs.ip6e_rthdr, u_char *);
104982cd038dSYoshinobu Inoue 			*mtod(exthdrs.ip6e_rthdr, u_char *) = IPPROTO_FRAGMENT;
105082cd038dSYoshinobu Inoue 		} else if (exthdrs.ip6e_dest1) {
105182cd038dSYoshinobu Inoue 			nextproto = *mtod(exthdrs.ip6e_dest1, u_char *);
105282cd038dSYoshinobu Inoue 			*mtod(exthdrs.ip6e_dest1, u_char *) = IPPROTO_FRAGMENT;
105382cd038dSYoshinobu Inoue 		} else if (exthdrs.ip6e_hbh) {
105482cd038dSYoshinobu Inoue 			nextproto = *mtod(exthdrs.ip6e_hbh, u_char *);
105582cd038dSYoshinobu Inoue 			*mtod(exthdrs.ip6e_hbh, u_char *) = IPPROTO_FRAGMENT;
105682cd038dSYoshinobu Inoue 		} else {
105782cd038dSYoshinobu Inoue 			nextproto = ip6->ip6_nxt;
105882cd038dSYoshinobu Inoue 			ip6->ip6_nxt = IPPROTO_FRAGMENT;
105982cd038dSYoshinobu Inoue 		}
106082cd038dSYoshinobu Inoue 
106182cd038dSYoshinobu Inoue 		/*
106282cd038dSYoshinobu Inoue 		 * Loop through length of segment after first fragment,
106388ff5695SSUZUKI Shinsuke 		 * make new header and copy data of each part and link onto
106488ff5695SSUZUKI Shinsuke 		 * chain.
106582cd038dSYoshinobu Inoue 		 */
106682cd038dSYoshinobu Inoue 		m0 = m;
106782cd038dSYoshinobu Inoue 		for (off = hlen; off < tlen; off += len) {
1068a163d034SWarner Losh 			MGETHDR(m, M_DONTWAIT, MT_HEADER);
106982cd038dSYoshinobu Inoue 			if (!m) {
107082cd038dSYoshinobu Inoue 				error = ENOBUFS;
107182cd038dSYoshinobu Inoue 				ip6stat.ip6s_odropped++;
107282cd038dSYoshinobu Inoue 				goto sendorfree;
107382cd038dSYoshinobu Inoue 			}
107433841545SHajimu UMEMOTO 			m->m_pkthdr.rcvif = NULL;
107582cd038dSYoshinobu Inoue 			m->m_flags = m0->m_flags & M_COPYFLAGS;
107682cd038dSYoshinobu Inoue 			*mnext = m;
107782cd038dSYoshinobu Inoue 			mnext = &m->m_nextpkt;
107882cd038dSYoshinobu Inoue 			m->m_data += max_linkhdr;
107982cd038dSYoshinobu Inoue 			mhip6 = mtod(m, struct ip6_hdr *);
108082cd038dSYoshinobu Inoue 			*mhip6 = *ip6;
108182cd038dSYoshinobu Inoue 			m->m_len = sizeof(*mhip6);
108282cd038dSYoshinobu Inoue 			error = ip6_insertfraghdr(m0, m, hlen, &ip6f);
108382cd038dSYoshinobu Inoue 			if (error) {
108482cd038dSYoshinobu Inoue 				ip6stat.ip6s_odropped++;
108582cd038dSYoshinobu Inoue 				goto sendorfree;
108682cd038dSYoshinobu Inoue 			}
108782cd038dSYoshinobu Inoue 			ip6f->ip6f_offlg = htons((u_short)((off - hlen) & ~7));
108882cd038dSYoshinobu Inoue 			if (off + len >= tlen)
108982cd038dSYoshinobu Inoue 				len = tlen - off;
109082cd038dSYoshinobu Inoue 			else
109182cd038dSYoshinobu Inoue 				ip6f->ip6f_offlg |= IP6F_MORE_FRAG;
109282cd038dSYoshinobu Inoue 			mhip6->ip6_plen = htons((u_short)(len + hlen +
10937efe5d92SHajimu UMEMOTO 			    sizeof(*ip6f) - sizeof(struct ip6_hdr)));
109482cd038dSYoshinobu Inoue 			if ((m_frgpart = m_copy(m0, off, len)) == 0) {
109582cd038dSYoshinobu Inoue 				error = ENOBUFS;
109682cd038dSYoshinobu Inoue 				ip6stat.ip6s_odropped++;
109782cd038dSYoshinobu Inoue 				goto sendorfree;
109882cd038dSYoshinobu Inoue 			}
109982cd038dSYoshinobu Inoue 			m_cat(m, m_frgpart);
110082cd038dSYoshinobu Inoue 			m->m_pkthdr.len = len + hlen + sizeof(*ip6f);
110182cd038dSYoshinobu Inoue 			m->m_pkthdr.rcvif = (struct ifnet *)0;
110282cd038dSYoshinobu Inoue 			ip6f->ip6f_reserved = 0;
110382cd038dSYoshinobu Inoue 			ip6f->ip6f_ident = id;
110482cd038dSYoshinobu Inoue 			ip6f->ip6f_nxt = nextproto;
110582cd038dSYoshinobu Inoue 			ip6stat.ip6s_ofragments++;
110682cd038dSYoshinobu Inoue 			in6_ifstat_inc(ifp, ifs6_out_fragcreat);
110782cd038dSYoshinobu Inoue 		}
110882cd038dSYoshinobu Inoue 
110982cd038dSYoshinobu Inoue 		in6_ifstat_inc(ifp, ifs6_out_fragok);
111082cd038dSYoshinobu Inoue 	}
111182cd038dSYoshinobu Inoue 
111282cd038dSYoshinobu Inoue 	/*
111382cd038dSYoshinobu Inoue 	 * Remove leading garbages.
111482cd038dSYoshinobu Inoue 	 */
111582cd038dSYoshinobu Inoue sendorfree:
111682cd038dSYoshinobu Inoue 	m = m0->m_nextpkt;
111782cd038dSYoshinobu Inoue 	m0->m_nextpkt = 0;
111882cd038dSYoshinobu Inoue 	m_freem(m0);
111982cd038dSYoshinobu Inoue 	for (m0 = m; m; m = m0) {
112082cd038dSYoshinobu Inoue 		m0 = m->m_nextpkt;
112182cd038dSYoshinobu Inoue 		m->m_nextpkt = 0;
112282cd038dSYoshinobu Inoue 		if (error == 0) {
1123fe937674SJosef Karthauser  			/* Record statistics for this interface address. */
1124fe937674SJosef Karthauser  			if (ia) {
1125fe937674SJosef Karthauser  				ia->ia_ifa.if_opackets++;
1126fe937674SJosef Karthauser  				ia->ia_ifa.if_obytes += m->m_pkthdr.len;
1127fe937674SJosef Karthauser  			}
112833841545SHajimu UMEMOTO #ifdef IPSEC
112933841545SHajimu UMEMOTO 			/* clean ipsec history once it goes out of the node */
113033841545SHajimu UMEMOTO 			ipsec_delaux(m);
113133841545SHajimu UMEMOTO #endif
1132686cdd19SJun-ichiro itojun Hagino 			error = nd6_output(ifp, origifp, m, dst, ro->ro_rt);
113382cd038dSYoshinobu Inoue 		} else
113482cd038dSYoshinobu Inoue 			m_freem(m);
113582cd038dSYoshinobu Inoue 	}
113682cd038dSYoshinobu Inoue 
113782cd038dSYoshinobu Inoue 	if (error == 0)
113882cd038dSYoshinobu Inoue 		ip6stat.ip6s_fragmented++;
113982cd038dSYoshinobu Inoue 
114082cd038dSYoshinobu Inoue done:
114182cd038dSYoshinobu Inoue 	if (ro == &ip6route && ro->ro_rt) { /* brace necessary for RTFREE */
114282cd038dSYoshinobu Inoue 		RTFREE(ro->ro_rt);
114382cd038dSYoshinobu Inoue 	} else if (ro_pmtu == &ip6route && ro_pmtu->ro_rt) {
114482cd038dSYoshinobu Inoue 		RTFREE(ro_pmtu->ro_rt);
114582cd038dSYoshinobu Inoue 	}
114682cd038dSYoshinobu Inoue 
114782cd038dSYoshinobu Inoue #ifdef IPSEC
114882cd038dSYoshinobu Inoue 	if (sp != NULL)
114982cd038dSYoshinobu Inoue 		key_freesp(sp);
115082cd038dSYoshinobu Inoue #endif /* IPSEC */
1151b9234fafSSam Leffler #ifdef FAST_IPSEC
1152b9234fafSSam Leffler 	if (sp != NULL)
1153b9234fafSSam Leffler 		KEY_FREESP(&sp);
1154b9234fafSSam Leffler #endif /* FAST_IPSEC */
115582cd038dSYoshinobu Inoue 
115682cd038dSYoshinobu Inoue 	return (error);
115782cd038dSYoshinobu Inoue 
115882cd038dSYoshinobu Inoue freehdrs:
115982cd038dSYoshinobu Inoue 	m_freem(exthdrs.ip6e_hbh);	/* m_freem will check if mbuf is 0 */
116082cd038dSYoshinobu Inoue 	m_freem(exthdrs.ip6e_dest1);
116182cd038dSYoshinobu Inoue 	m_freem(exthdrs.ip6e_rthdr);
116282cd038dSYoshinobu Inoue 	m_freem(exthdrs.ip6e_dest2);
11637efe5d92SHajimu UMEMOTO 	/* FALLTHROUGH */
116482cd038dSYoshinobu Inoue bad:
116582cd038dSYoshinobu Inoue 	m_freem(m);
116682cd038dSYoshinobu Inoue 	goto done;
116782cd038dSYoshinobu Inoue }
116882cd038dSYoshinobu Inoue 
116982cd038dSYoshinobu Inoue static int
117082cd038dSYoshinobu Inoue ip6_copyexthdr(mp, hdr, hlen)
117182cd038dSYoshinobu Inoue 	struct mbuf **mp;
117282cd038dSYoshinobu Inoue 	caddr_t hdr;
117382cd038dSYoshinobu Inoue 	int hlen;
117482cd038dSYoshinobu Inoue {
117582cd038dSYoshinobu Inoue 	struct mbuf *m;
117682cd038dSYoshinobu Inoue 
117782cd038dSYoshinobu Inoue 	if (hlen > MCLBYTES)
117882cd038dSYoshinobu Inoue 		return (ENOBUFS); /* XXX */
117982cd038dSYoshinobu Inoue 
1180a163d034SWarner Losh 	MGET(m, M_DONTWAIT, MT_DATA);
118182cd038dSYoshinobu Inoue 	if (!m)
118282cd038dSYoshinobu Inoue 		return (ENOBUFS);
118382cd038dSYoshinobu Inoue 
118482cd038dSYoshinobu Inoue 	if (hlen > MLEN) {
1185a163d034SWarner Losh 		MCLGET(m, M_DONTWAIT);
118682cd038dSYoshinobu Inoue 		if ((m->m_flags & M_EXT) == 0) {
118782cd038dSYoshinobu Inoue 			m_free(m);
118882cd038dSYoshinobu Inoue 			return (ENOBUFS);
118982cd038dSYoshinobu Inoue 		}
119082cd038dSYoshinobu Inoue 	}
119182cd038dSYoshinobu Inoue 	m->m_len = hlen;
119282cd038dSYoshinobu Inoue 	if (hdr)
119382cd038dSYoshinobu Inoue 		bcopy(hdr, mtod(m, caddr_t), hlen);
119482cd038dSYoshinobu Inoue 
119582cd038dSYoshinobu Inoue 	*mp = m;
119682cd038dSYoshinobu Inoue 	return (0);
119782cd038dSYoshinobu Inoue }
119882cd038dSYoshinobu Inoue 
119982cd038dSYoshinobu Inoue /*
120082cd038dSYoshinobu Inoue  * Insert jumbo payload option.
120182cd038dSYoshinobu Inoue  */
120282cd038dSYoshinobu Inoue static int
120382cd038dSYoshinobu Inoue ip6_insert_jumboopt(exthdrs, plen)
120482cd038dSYoshinobu Inoue 	struct ip6_exthdrs *exthdrs;
120582cd038dSYoshinobu Inoue 	u_int32_t plen;
120682cd038dSYoshinobu Inoue {
120782cd038dSYoshinobu Inoue 	struct mbuf *mopt;
120882cd038dSYoshinobu Inoue 	u_char *optbuf;
120933841545SHajimu UMEMOTO 	u_int32_t v;
121082cd038dSYoshinobu Inoue 
121182cd038dSYoshinobu Inoue #define JUMBOOPTLEN	8	/* length of jumbo payload option and padding */
121282cd038dSYoshinobu Inoue 
121382cd038dSYoshinobu Inoue 	/*
121482cd038dSYoshinobu Inoue 	 * If there is no hop-by-hop options header, allocate new one.
121582cd038dSYoshinobu Inoue 	 * If there is one but it doesn't have enough space to store the
121682cd038dSYoshinobu Inoue 	 * jumbo payload option, allocate a cluster to store the whole options.
121782cd038dSYoshinobu Inoue 	 * Otherwise, use it to store the options.
121882cd038dSYoshinobu Inoue 	 */
121982cd038dSYoshinobu Inoue 	if (exthdrs->ip6e_hbh == 0) {
1220a163d034SWarner Losh 		MGET(mopt, M_DONTWAIT, MT_DATA);
122182cd038dSYoshinobu Inoue 		if (mopt == 0)
122282cd038dSYoshinobu Inoue 			return (ENOBUFS);
122382cd038dSYoshinobu Inoue 		mopt->m_len = JUMBOOPTLEN;
122482cd038dSYoshinobu Inoue 		optbuf = mtod(mopt, u_char *);
122582cd038dSYoshinobu Inoue 		optbuf[1] = 0;	/* = ((JUMBOOPTLEN) >> 3) - 1 */
122682cd038dSYoshinobu Inoue 		exthdrs->ip6e_hbh = mopt;
122782cd038dSYoshinobu Inoue 	} else {
122882cd038dSYoshinobu Inoue 		struct ip6_hbh *hbh;
122982cd038dSYoshinobu Inoue 
123082cd038dSYoshinobu Inoue 		mopt = exthdrs->ip6e_hbh;
123182cd038dSYoshinobu Inoue 		if (M_TRAILINGSPACE(mopt) < JUMBOOPTLEN) {
123233841545SHajimu UMEMOTO 			/*
123333841545SHajimu UMEMOTO 			 * XXX assumption:
123433841545SHajimu UMEMOTO 			 * - exthdrs->ip6e_hbh is not referenced from places
123533841545SHajimu UMEMOTO 			 *   other than exthdrs.
123633841545SHajimu UMEMOTO 			 * - exthdrs->ip6e_hbh is not an mbuf chain.
123733841545SHajimu UMEMOTO 			 */
123882cd038dSYoshinobu Inoue 			int oldoptlen = mopt->m_len;
123933841545SHajimu UMEMOTO 			struct mbuf *n;
124082cd038dSYoshinobu Inoue 
124133841545SHajimu UMEMOTO 			/*
124233841545SHajimu UMEMOTO 			 * XXX: give up if the whole (new) hbh header does
124333841545SHajimu UMEMOTO 			 * not fit even in an mbuf cluster.
124433841545SHajimu UMEMOTO 			 */
124533841545SHajimu UMEMOTO 			if (oldoptlen + JUMBOOPTLEN > MCLBYTES)
124682cd038dSYoshinobu Inoue 				return (ENOBUFS);
124782cd038dSYoshinobu Inoue 
124833841545SHajimu UMEMOTO 			/*
124933841545SHajimu UMEMOTO 			 * As a consequence, we must always prepare a cluster
125033841545SHajimu UMEMOTO 			 * at this point.
125133841545SHajimu UMEMOTO 			 */
1252a163d034SWarner Losh 			MGET(n, M_DONTWAIT, MT_DATA);
125333841545SHajimu UMEMOTO 			if (n) {
1254a163d034SWarner Losh 				MCLGET(n, M_DONTWAIT);
125533841545SHajimu UMEMOTO 				if ((n->m_flags & M_EXT) == 0) {
125633841545SHajimu UMEMOTO 					m_freem(n);
125733841545SHajimu UMEMOTO 					n = NULL;
125833841545SHajimu UMEMOTO 				}
125933841545SHajimu UMEMOTO 			}
126033841545SHajimu UMEMOTO 			if (!n)
126133841545SHajimu UMEMOTO 				return (ENOBUFS);
126233841545SHajimu UMEMOTO 			n->m_len = oldoptlen + JUMBOOPTLEN;
126333841545SHajimu UMEMOTO 			bcopy(mtod(mopt, caddr_t), mtod(n, caddr_t),
126433841545SHajimu UMEMOTO 			    oldoptlen);
126533841545SHajimu UMEMOTO 			optbuf = mtod(n, caddr_t) + oldoptlen;
126633841545SHajimu UMEMOTO 			m_freem(mopt);
126733841545SHajimu UMEMOTO 			mopt = exthdrs->ip6e_hbh = n;
126882cd038dSYoshinobu Inoue 		} else {
126982cd038dSYoshinobu Inoue 			optbuf = mtod(mopt, u_char *) + mopt->m_len;
127082cd038dSYoshinobu Inoue 			mopt->m_len += JUMBOOPTLEN;
127182cd038dSYoshinobu Inoue 		}
127282cd038dSYoshinobu Inoue 		optbuf[0] = IP6OPT_PADN;
127382cd038dSYoshinobu Inoue 		optbuf[1] = 1;
127482cd038dSYoshinobu Inoue 
127582cd038dSYoshinobu Inoue 		/*
127682cd038dSYoshinobu Inoue 		 * Adjust the header length according to the pad and
127782cd038dSYoshinobu Inoue 		 * the jumbo payload option.
127882cd038dSYoshinobu Inoue 		 */
127982cd038dSYoshinobu Inoue 		hbh = mtod(mopt, struct ip6_hbh *);
128082cd038dSYoshinobu Inoue 		hbh->ip6h_len += (JUMBOOPTLEN >> 3);
128182cd038dSYoshinobu Inoue 	}
128282cd038dSYoshinobu Inoue 
128382cd038dSYoshinobu Inoue 	/* fill in the option. */
128482cd038dSYoshinobu Inoue 	optbuf[2] = IP6OPT_JUMBO;
128582cd038dSYoshinobu Inoue 	optbuf[3] = 4;
128633841545SHajimu UMEMOTO 	v = (u_int32_t)htonl(plen + JUMBOOPTLEN);
128733841545SHajimu UMEMOTO 	bcopy(&v, &optbuf[4], sizeof(u_int32_t));
128882cd038dSYoshinobu Inoue 
128982cd038dSYoshinobu Inoue 	/* finally, adjust the packet header length */
129082cd038dSYoshinobu Inoue 	exthdrs->ip6e_ip6->m_pkthdr.len += JUMBOOPTLEN;
129182cd038dSYoshinobu Inoue 
129282cd038dSYoshinobu Inoue 	return (0);
129382cd038dSYoshinobu Inoue #undef JUMBOOPTLEN
129482cd038dSYoshinobu Inoue }
129582cd038dSYoshinobu Inoue 
129682cd038dSYoshinobu Inoue /*
129782cd038dSYoshinobu Inoue  * Insert fragment header and copy unfragmentable header portions.
129882cd038dSYoshinobu Inoue  */
129982cd038dSYoshinobu Inoue static int
130082cd038dSYoshinobu Inoue ip6_insertfraghdr(m0, m, hlen, frghdrp)
130182cd038dSYoshinobu Inoue 	struct mbuf *m0, *m;
130282cd038dSYoshinobu Inoue 	int hlen;
130382cd038dSYoshinobu Inoue 	struct ip6_frag **frghdrp;
130482cd038dSYoshinobu Inoue {
130582cd038dSYoshinobu Inoue 	struct mbuf *n, *mlast;
130682cd038dSYoshinobu Inoue 
130782cd038dSYoshinobu Inoue 	if (hlen > sizeof(struct ip6_hdr)) {
130882cd038dSYoshinobu Inoue 		n = m_copym(m0, sizeof(struct ip6_hdr),
1309a163d034SWarner Losh 		    hlen - sizeof(struct ip6_hdr), M_DONTWAIT);
131082cd038dSYoshinobu Inoue 		if (n == 0)
131182cd038dSYoshinobu Inoue 			return (ENOBUFS);
131282cd038dSYoshinobu Inoue 		m->m_next = n;
131382cd038dSYoshinobu Inoue 	} else
131482cd038dSYoshinobu Inoue 		n = m;
131582cd038dSYoshinobu Inoue 
131682cd038dSYoshinobu Inoue 	/* Search for the last mbuf of unfragmentable part. */
131782cd038dSYoshinobu Inoue 	for (mlast = n; mlast->m_next; mlast = mlast->m_next)
131882cd038dSYoshinobu Inoue 		;
131982cd038dSYoshinobu Inoue 
132082cd038dSYoshinobu Inoue 	if ((mlast->m_flags & M_EXT) == 0 &&
1321686cdd19SJun-ichiro itojun Hagino 	    M_TRAILINGSPACE(mlast) >= sizeof(struct ip6_frag)) {
132282cd038dSYoshinobu Inoue 		/* use the trailing space of the last mbuf for the fragment hdr */
13237efe5d92SHajimu UMEMOTO 		*frghdrp = (struct ip6_frag *)(mtod(mlast, caddr_t) +
13247efe5d92SHajimu UMEMOTO 		    mlast->m_len);
132582cd038dSYoshinobu Inoue 		mlast->m_len += sizeof(struct ip6_frag);
132682cd038dSYoshinobu Inoue 		m->m_pkthdr.len += sizeof(struct ip6_frag);
132782cd038dSYoshinobu Inoue 	} else {
132882cd038dSYoshinobu Inoue 		/* allocate a new mbuf for the fragment header */
132982cd038dSYoshinobu Inoue 		struct mbuf *mfrg;
133082cd038dSYoshinobu Inoue 
1331a163d034SWarner Losh 		MGET(mfrg, M_DONTWAIT, MT_DATA);
133282cd038dSYoshinobu Inoue 		if (mfrg == 0)
133382cd038dSYoshinobu Inoue 			return (ENOBUFS);
133482cd038dSYoshinobu Inoue 		mfrg->m_len = sizeof(struct ip6_frag);
133582cd038dSYoshinobu Inoue 		*frghdrp = mtod(mfrg, struct ip6_frag *);
133682cd038dSYoshinobu Inoue 		mlast->m_next = mfrg;
133782cd038dSYoshinobu Inoue 	}
133882cd038dSYoshinobu Inoue 
133982cd038dSYoshinobu Inoue 	return (0);
134082cd038dSYoshinobu Inoue }
134182cd038dSYoshinobu Inoue 
134231b3783cSHajimu UMEMOTO static int
1343f95d4633SHajimu UMEMOTO ip6_getpmtu(ro_pmtu, ro, ifp, dst, mtup, alwaysfragp)
134431b3783cSHajimu UMEMOTO 	struct route_in6 *ro_pmtu, *ro;
134531b3783cSHajimu UMEMOTO 	struct ifnet *ifp;
134631b3783cSHajimu UMEMOTO 	struct in6_addr *dst;
134731b3783cSHajimu UMEMOTO 	u_long *mtup;
1348f95d4633SHajimu UMEMOTO 	int *alwaysfragp;
134931b3783cSHajimu UMEMOTO {
135031b3783cSHajimu UMEMOTO 	u_int32_t mtu = 0;
1351f95d4633SHajimu UMEMOTO 	int alwaysfrag = 0;
135231b3783cSHajimu UMEMOTO 	int error = 0;
135331b3783cSHajimu UMEMOTO 
135431b3783cSHajimu UMEMOTO 	if (ro_pmtu != ro) {
135531b3783cSHajimu UMEMOTO 		/* The first hop and the final destination may differ. */
135631b3783cSHajimu UMEMOTO 		struct sockaddr_in6 *sa6_dst =
135731b3783cSHajimu UMEMOTO 		    (struct sockaddr_in6 *)&ro_pmtu->ro_dst;
135831b3783cSHajimu UMEMOTO 		if (ro_pmtu->ro_rt &&
135931b3783cSHajimu UMEMOTO 		    ((ro->ro_rt->rt_flags & RTF_UP) == 0 ||
136031b3783cSHajimu UMEMOTO 		     !IN6_ARE_ADDR_EQUAL(&sa6_dst->sin6_addr, dst))) {
136131b3783cSHajimu UMEMOTO 			RTFREE(ro_pmtu->ro_rt);
136231b3783cSHajimu UMEMOTO 			ro_pmtu->ro_rt = (struct rtentry *)NULL;
136331b3783cSHajimu UMEMOTO 		}
136431b3783cSHajimu UMEMOTO 		if (ro_pmtu->ro_rt == NULL) {
136531b3783cSHajimu UMEMOTO 			bzero(sa6_dst, sizeof(*sa6_dst));
136631b3783cSHajimu UMEMOTO 			sa6_dst->sin6_family = AF_INET6;
136731b3783cSHajimu UMEMOTO 			sa6_dst->sin6_len = sizeof(struct sockaddr_in6);
136831b3783cSHajimu UMEMOTO 			sa6_dst->sin6_addr = *dst;
136931b3783cSHajimu UMEMOTO 
137031b3783cSHajimu UMEMOTO 			rtalloc((struct route *)ro_pmtu);
137131b3783cSHajimu UMEMOTO 		}
137231b3783cSHajimu UMEMOTO 	}
137331b3783cSHajimu UMEMOTO 	if (ro_pmtu->ro_rt) {
137431b3783cSHajimu UMEMOTO 		u_int32_t ifmtu;
137531b3783cSHajimu UMEMOTO 
137631b3783cSHajimu UMEMOTO 		if (ifp == NULL)
137731b3783cSHajimu UMEMOTO 			ifp = ro_pmtu->ro_rt->rt_ifp;
137831b3783cSHajimu UMEMOTO 		ifmtu = IN6_LINKMTU(ifp);
137931b3783cSHajimu UMEMOTO 		mtu = ro_pmtu->ro_rt->rt_rmx.rmx_mtu;
138031b3783cSHajimu UMEMOTO 		if (mtu == 0)
138131b3783cSHajimu UMEMOTO 			mtu = ifmtu;
1382f95d4633SHajimu UMEMOTO 		else if (mtu < IPV6_MMTU) {
1383f95d4633SHajimu UMEMOTO 			/*
1384f95d4633SHajimu UMEMOTO 			 * RFC2460 section 5, last paragraph:
1385f95d4633SHajimu UMEMOTO 			 * if we record ICMPv6 too big message with
1386f95d4633SHajimu UMEMOTO 			 * mtu < IPV6_MMTU, transmit packets sized IPV6_MMTU
1387f95d4633SHajimu UMEMOTO 			 * or smaller, with framgent header attached.
1388f95d4633SHajimu UMEMOTO 			 * (fragment header is needed regardless from the
1389f95d4633SHajimu UMEMOTO 			 * packet size, for translators to identify packets)
1390f95d4633SHajimu UMEMOTO 			 */
1391f95d4633SHajimu UMEMOTO 			alwaysfrag = 1;
1392f95d4633SHajimu UMEMOTO 			mtu = IPV6_MMTU;
1393f95d4633SHajimu UMEMOTO 		} else if (mtu > ifmtu) {
139431b3783cSHajimu UMEMOTO 			/*
139531b3783cSHajimu UMEMOTO 			 * The MTU on the route is larger than the MTU on
139631b3783cSHajimu UMEMOTO 			 * the interface!  This shouldn't happen, unless the
139731b3783cSHajimu UMEMOTO 			 * MTU of the interface has been changed after the
139831b3783cSHajimu UMEMOTO 			 * interface was brought up.  Change the MTU in the
139931b3783cSHajimu UMEMOTO 			 * route to match the interface MTU (as long as the
140031b3783cSHajimu UMEMOTO 			 * field isn't locked).
140131b3783cSHajimu UMEMOTO 			 */
140231b3783cSHajimu UMEMOTO 			mtu = ifmtu;
140331b3783cSHajimu UMEMOTO 			if (!(ro_pmtu->ro_rt->rt_rmx.rmx_locks & RTV_MTU))
140431b3783cSHajimu UMEMOTO 				ro_pmtu->ro_rt->rt_rmx.rmx_mtu = mtu;
140531b3783cSHajimu UMEMOTO 		}
140631b3783cSHajimu UMEMOTO 	} else if (ifp) {
140731b3783cSHajimu UMEMOTO 		mtu = IN6_LINKMTU(ifp);
140831b3783cSHajimu UMEMOTO 	} else
140931b3783cSHajimu UMEMOTO 		error = EHOSTUNREACH; /* XXX */
141031b3783cSHajimu UMEMOTO 
141131b3783cSHajimu UMEMOTO 	*mtup = mtu;
1412f95d4633SHajimu UMEMOTO 	if (alwaysfragp)
1413f95d4633SHajimu UMEMOTO 		*alwaysfragp = alwaysfrag;
141431b3783cSHajimu UMEMOTO 	return (error);
141531b3783cSHajimu UMEMOTO }
141631b3783cSHajimu UMEMOTO 
141782cd038dSYoshinobu Inoue /*
141882cd038dSYoshinobu Inoue  * IP6 socket option processing.
141982cd038dSYoshinobu Inoue  */
142082cd038dSYoshinobu Inoue int
142182cd038dSYoshinobu Inoue ip6_ctloutput(so, sopt)
142282cd038dSYoshinobu Inoue 	struct socket *so;
142382cd038dSYoshinobu Inoue 	struct sockopt *sopt;
142482cd038dSYoshinobu Inoue {
1425f95d4633SHajimu UMEMOTO 	int privileged, optdatalen, uproto;
1426f95d4633SHajimu UMEMOTO 	void *optdata;
142733841545SHajimu UMEMOTO 	struct inpcb *in6p = sotoinpcb(so);
142882cd038dSYoshinobu Inoue 	int error, optval;
142982cd038dSYoshinobu Inoue 	int level, op, optname;
143082cd038dSYoshinobu Inoue 	int optlen;
1431b40ce416SJulian Elischer 	struct thread *td;
143282cd038dSYoshinobu Inoue 
143382cd038dSYoshinobu Inoue 	if (sopt) {
143482cd038dSYoshinobu Inoue 		level = sopt->sopt_level;
143582cd038dSYoshinobu Inoue 		op = sopt->sopt_dir;
143682cd038dSYoshinobu Inoue 		optname = sopt->sopt_name;
143782cd038dSYoshinobu Inoue 		optlen = sopt->sopt_valsize;
1438b40ce416SJulian Elischer 		td = sopt->sopt_td;
143982cd038dSYoshinobu Inoue 	} else {
144082cd038dSYoshinobu Inoue 		panic("ip6_ctloutput: arg soopt is NULL");
144182cd038dSYoshinobu Inoue 	}
144282cd038dSYoshinobu Inoue 	error = optval = 0;
144382cd038dSYoshinobu Inoue 
144444731cabSJohn Baldwin 	privileged = (td == 0 || suser(td)) ? 0 : 1;
1445f95d4633SHajimu UMEMOTO 	uproto = (int)so->so_proto->pr_protocol;
144682cd038dSYoshinobu Inoue 
144782cd038dSYoshinobu Inoue 	if (level == IPPROTO_IPV6) {
144882cd038dSYoshinobu Inoue 		switch (op) {
144933841545SHajimu UMEMOTO 
145082cd038dSYoshinobu Inoue 		case SOPT_SET:
145182cd038dSYoshinobu Inoue 			switch (optname) {
1452f95d4633SHajimu UMEMOTO 			case IPV6_2292PKTOPTIONS:
1453f95d4633SHajimu UMEMOTO #ifdef IPV6_PKTOPTIONS
145482cd038dSYoshinobu Inoue 			case IPV6_PKTOPTIONS:
1455f95d4633SHajimu UMEMOTO #endif
145682cd038dSYoshinobu Inoue 			{
145782cd038dSYoshinobu Inoue 				struct mbuf *m;
145882cd038dSYoshinobu Inoue 
145982cd038dSYoshinobu Inoue 				error = soopt_getm(sopt, &m); /* XXX */
14607efe5d92SHajimu UMEMOTO 				if (error != NULL)
146182cd038dSYoshinobu Inoue 					break;
146282cd038dSYoshinobu Inoue 				error = soopt_mcopyin(sopt, m); /* XXX */
14637efe5d92SHajimu UMEMOTO 				if (error != NULL)
146482cd038dSYoshinobu Inoue 					break;
146533841545SHajimu UMEMOTO 				error = ip6_pcbopts(&in6p->in6p_outputopts,
146633841545SHajimu UMEMOTO 						    m, so, sopt);
146733841545SHajimu UMEMOTO 				m_freem(m); /* XXX */
146882cd038dSYoshinobu Inoue 				break;
146982cd038dSYoshinobu Inoue 			}
147033841545SHajimu UMEMOTO 
147133841545SHajimu UMEMOTO 			/*
147233841545SHajimu UMEMOTO 			 * Use of some Hop-by-Hop options or some
147333841545SHajimu UMEMOTO 			 * Destination options, might require special
147433841545SHajimu UMEMOTO 			 * privilege.  That is, normal applications
147533841545SHajimu UMEMOTO 			 * (without special privilege) might be forbidden
147633841545SHajimu UMEMOTO 			 * from setting certain options in outgoing packets,
147733841545SHajimu UMEMOTO 			 * and might never see certain options in received
147833841545SHajimu UMEMOTO 			 * packets. [RFC 2292 Section 6]
147933841545SHajimu UMEMOTO 			 * KAME specific note:
148033841545SHajimu UMEMOTO 			 *  KAME prevents non-privileged users from sending or
148133841545SHajimu UMEMOTO 			 *  receiving ANY hbh/dst options in order to avoid
148233841545SHajimu UMEMOTO 			 *  overhead of parsing options in the kernel.
148333841545SHajimu UMEMOTO 			 */
1484f95d4633SHajimu UMEMOTO 			case IPV6_RECVHOPOPTS:
1485f95d4633SHajimu UMEMOTO 			case IPV6_RECVDSTOPTS:
1486f95d4633SHajimu UMEMOTO 			case IPV6_RECVRTHDRDSTOPTS:
1487f95d4633SHajimu UMEMOTO 				if (!privileged) {
1488f95d4633SHajimu UMEMOTO 					error = EPERM;
1489f95d4633SHajimu UMEMOTO 					break;
1490f95d4633SHajimu UMEMOTO 				}
1491f95d4633SHajimu UMEMOTO 				/* FALLTHROUGH */
149282cd038dSYoshinobu Inoue 			case IPV6_UNICAST_HOPS:
1493f95d4633SHajimu UMEMOTO 			case IPV6_HOPLIMIT:
149482cd038dSYoshinobu Inoue 			case IPV6_FAITH:
149533841545SHajimu UMEMOTO 
1496f95d4633SHajimu UMEMOTO 			case IPV6_RECVPKTINFO:
1497f95d4633SHajimu UMEMOTO 			case IPV6_RECVHOPLIMIT:
1498f95d4633SHajimu UMEMOTO 			case IPV6_RECVRTHDR:
1499f95d4633SHajimu UMEMOTO 			case IPV6_RECVPATHMTU:
1500f95d4633SHajimu UMEMOTO 			case IPV6_RECVTCLASS:
150133841545SHajimu UMEMOTO 			case IPV6_V6ONLY:
1502f95d4633SHajimu UMEMOTO 			case IPV6_AUTOFLOWLABEL:
150333841545SHajimu UMEMOTO 				if (optlen != sizeof(int)) {
150482cd038dSYoshinobu Inoue 					error = EINVAL;
150533841545SHajimu UMEMOTO 					break;
150633841545SHajimu UMEMOTO 				}
150782cd038dSYoshinobu Inoue 				error = sooptcopyin(sopt, &optval,
150882cd038dSYoshinobu Inoue 					sizeof optval, sizeof optval);
150982cd038dSYoshinobu Inoue 				if (error)
151082cd038dSYoshinobu Inoue 					break;
151182cd038dSYoshinobu Inoue 				switch (optname) {
151282cd038dSYoshinobu Inoue 
151382cd038dSYoshinobu Inoue 				case IPV6_UNICAST_HOPS:
151482cd038dSYoshinobu Inoue 					if (optval < -1 || optval >= 256)
151582cd038dSYoshinobu Inoue 						error = EINVAL;
151682cd038dSYoshinobu Inoue 					else {
151782cd038dSYoshinobu Inoue 						/* -1 = kernel default */
151882cd038dSYoshinobu Inoue 						in6p->in6p_hops = optval;
151982cd038dSYoshinobu Inoue 						if ((in6p->in6p_vflag &
152082cd038dSYoshinobu Inoue 						     INP_IPV4) != 0)
152182cd038dSYoshinobu Inoue 							in6p->inp_ip_ttl = optval;
152282cd038dSYoshinobu Inoue 					}
152382cd038dSYoshinobu Inoue 					break;
152482cd038dSYoshinobu Inoue #define OPTSET(bit) \
152533841545SHajimu UMEMOTO do { \
152682cd038dSYoshinobu Inoue 	if (optval) \
152733841545SHajimu UMEMOTO 		in6p->in6p_flags |= (bit); \
152882cd038dSYoshinobu Inoue 	else \
152933841545SHajimu UMEMOTO 		in6p->in6p_flags &= ~(bit); \
15307efe5d92SHajimu UMEMOTO } while (/*CONSTCOND*/ 0)
1531f95d4633SHajimu UMEMOTO #define OPTSET2292(bit) \
1532f95d4633SHajimu UMEMOTO do { \
1533f95d4633SHajimu UMEMOTO 	in6p->in6p_flags |= IN6P_RFC2292; \
1534f95d4633SHajimu UMEMOTO 	if (optval) \
1535f95d4633SHajimu UMEMOTO 		in6p->in6p_flags |= (bit); \
1536f95d4633SHajimu UMEMOTO 	else \
1537f95d4633SHajimu UMEMOTO 		in6p->in6p_flags &= ~(bit); \
1538f95d4633SHajimu UMEMOTO } while (/*CONSTCOND*/ 0)
153933841545SHajimu UMEMOTO #define OPTBIT(bit) (in6p->in6p_flags & (bit) ? 1 : 0)
154082cd038dSYoshinobu Inoue 
1541f95d4633SHajimu UMEMOTO 				case IPV6_RECVPKTINFO:
1542f95d4633SHajimu UMEMOTO 					/* cannot mix with RFC2292 */
1543f95d4633SHajimu UMEMOTO 					if (OPTBIT(IN6P_RFC2292)) {
1544f95d4633SHajimu UMEMOTO 						error = EINVAL;
1545f95d4633SHajimu UMEMOTO 						break;
1546f95d4633SHajimu UMEMOTO 					}
1547f95d4633SHajimu UMEMOTO 					OPTSET(IN6P_PKTINFO);
1548f95d4633SHajimu UMEMOTO 					break;
1549f95d4633SHajimu UMEMOTO 
1550f95d4633SHajimu UMEMOTO 				case IPV6_HOPLIMIT:
1551f95d4633SHajimu UMEMOTO 				{
1552f95d4633SHajimu UMEMOTO 					struct ip6_pktopts **optp;
1553f95d4633SHajimu UMEMOTO 
1554f95d4633SHajimu UMEMOTO 					/* cannot mix with RFC2292 */
1555f95d4633SHajimu UMEMOTO 					if (OPTBIT(IN6P_RFC2292)) {
1556f95d4633SHajimu UMEMOTO 						error = EINVAL;
1557f95d4633SHajimu UMEMOTO 						break;
1558f95d4633SHajimu UMEMOTO 					}
1559f95d4633SHajimu UMEMOTO 					optp = &in6p->in6p_outputopts;
1560f95d4633SHajimu UMEMOTO 					error = ip6_pcbopt(IPV6_HOPLIMIT,
1561f95d4633SHajimu UMEMOTO 							   (u_char *)&optval,
1562f95d4633SHajimu UMEMOTO 							   sizeof(optval),
1563f95d4633SHajimu UMEMOTO 							   optp,
1564f95d4633SHajimu UMEMOTO 							   privileged, uproto);
1565f95d4633SHajimu UMEMOTO 					break;
1566f95d4633SHajimu UMEMOTO 				}
1567f95d4633SHajimu UMEMOTO 
1568f95d4633SHajimu UMEMOTO 				case IPV6_RECVHOPLIMIT:
1569f95d4633SHajimu UMEMOTO 					/* cannot mix with RFC2292 */
1570f95d4633SHajimu UMEMOTO 					if (OPTBIT(IN6P_RFC2292)) {
1571f95d4633SHajimu UMEMOTO 						error = EINVAL;
1572f95d4633SHajimu UMEMOTO 						break;
1573f95d4633SHajimu UMEMOTO 					}
1574f95d4633SHajimu UMEMOTO 					OPTSET(IN6P_HOPLIMIT);
1575f95d4633SHajimu UMEMOTO 					break;
1576f95d4633SHajimu UMEMOTO 
1577f95d4633SHajimu UMEMOTO 				case IPV6_RECVHOPOPTS:
1578f95d4633SHajimu UMEMOTO 					/* cannot mix with RFC2292 */
1579f95d4633SHajimu UMEMOTO 					if (OPTBIT(IN6P_RFC2292)) {
1580f95d4633SHajimu UMEMOTO 						error = EINVAL;
1581f95d4633SHajimu UMEMOTO 						break;
1582f95d4633SHajimu UMEMOTO 					}
1583f95d4633SHajimu UMEMOTO 					OPTSET(IN6P_HOPOPTS);
1584f95d4633SHajimu UMEMOTO 					break;
1585f95d4633SHajimu UMEMOTO 
1586f95d4633SHajimu UMEMOTO 				case IPV6_RECVDSTOPTS:
1587f95d4633SHajimu UMEMOTO 					/* cannot mix with RFC2292 */
1588f95d4633SHajimu UMEMOTO 					if (OPTBIT(IN6P_RFC2292)) {
1589f95d4633SHajimu UMEMOTO 						error = EINVAL;
1590f95d4633SHajimu UMEMOTO 						break;
1591f95d4633SHajimu UMEMOTO 					}
1592f95d4633SHajimu UMEMOTO 					OPTSET(IN6P_DSTOPTS);
1593f95d4633SHajimu UMEMOTO 					break;
1594f95d4633SHajimu UMEMOTO 
1595f95d4633SHajimu UMEMOTO 				case IPV6_RECVRTHDRDSTOPTS:
1596f95d4633SHajimu UMEMOTO 					/* cannot mix with RFC2292 */
1597f95d4633SHajimu UMEMOTO 					if (OPTBIT(IN6P_RFC2292)) {
1598f95d4633SHajimu UMEMOTO 						error = EINVAL;
1599f95d4633SHajimu UMEMOTO 						break;
1600f95d4633SHajimu UMEMOTO 					}
1601f95d4633SHajimu UMEMOTO 					OPTSET(IN6P_RTHDRDSTOPTS);
1602f95d4633SHajimu UMEMOTO 					break;
1603f95d4633SHajimu UMEMOTO 
1604f95d4633SHajimu UMEMOTO 				case IPV6_RECVRTHDR:
1605f95d4633SHajimu UMEMOTO 					/* cannot mix with RFC2292 */
1606f95d4633SHajimu UMEMOTO 					if (OPTBIT(IN6P_RFC2292)) {
1607f95d4633SHajimu UMEMOTO 						error = EINVAL;
1608f95d4633SHajimu UMEMOTO 						break;
1609f95d4633SHajimu UMEMOTO 					}
1610f95d4633SHajimu UMEMOTO 					OPTSET(IN6P_RTHDR);
161182cd038dSYoshinobu Inoue 					break;
161282cd038dSYoshinobu Inoue 
161382cd038dSYoshinobu Inoue 				case IPV6_FAITH:
161482cd038dSYoshinobu Inoue 					OPTSET(IN6P_FAITH);
161582cd038dSYoshinobu Inoue 					break;
161682cd038dSYoshinobu Inoue 
1617f95d4633SHajimu UMEMOTO 				case IPV6_RECVPATHMTU:
1618f95d4633SHajimu UMEMOTO 					/*
1619f95d4633SHajimu UMEMOTO 					 * We ignore this option for TCP
1620f95d4633SHajimu UMEMOTO 					 * sockets.
1621f95d4633SHajimu UMEMOTO 					 * (rfc2292bis leaves this case
1622f95d4633SHajimu UMEMOTO 					 * unspecified.)
1623f95d4633SHajimu UMEMOTO 					 */
1624f95d4633SHajimu UMEMOTO 					if (uproto != IPPROTO_TCP)
1625f95d4633SHajimu UMEMOTO 						OPTSET(IN6P_MTU);
1626f95d4633SHajimu UMEMOTO 					break;
1627f95d4633SHajimu UMEMOTO 
162833841545SHajimu UMEMOTO 				case IPV6_V6ONLY:
162933841545SHajimu UMEMOTO 					/*
16300554093bSHajimu UMEMOTO 					 * make setsockopt(IPV6_V6ONLY)
16310554093bSHajimu UMEMOTO 					 * available only prior to bind(2).
16320554093bSHajimu UMEMOTO 					 * see ipng mailing list, Jun 22 2001.
16330554093bSHajimu UMEMOTO 					 */
16340554093bSHajimu UMEMOTO 					if (in6p->in6p_lport ||
16357efe5d92SHajimu UMEMOTO 					    !IN6_IS_ADDR_UNSPECIFIED(&in6p->in6p_laddr)) {
16360554093bSHajimu UMEMOTO 						error = EINVAL;
16370554093bSHajimu UMEMOTO 						break;
16380554093bSHajimu UMEMOTO 					}
163933841545SHajimu UMEMOTO 					OPTSET(IN6P_IPV6_V6ONLY);
164012253795SHajimu UMEMOTO 					if (optval)
164112253795SHajimu UMEMOTO 						in6p->in6p_vflag &= ~INP_IPV4;
164212253795SHajimu UMEMOTO 					else
164312253795SHajimu UMEMOTO 						in6p->in6p_vflag |= INP_IPV4;
164482cd038dSYoshinobu Inoue 					break;
1645f95d4633SHajimu UMEMOTO 				case IPV6_RECVTCLASS:
1646f95d4633SHajimu UMEMOTO 					/* cannot mix with RFC2292 XXX */
1647f95d4633SHajimu UMEMOTO 					if (OPTBIT(IN6P_RFC2292)) {
1648f95d4633SHajimu UMEMOTO 						error = EINVAL;
1649f95d4633SHajimu UMEMOTO 						break;
1650f95d4633SHajimu UMEMOTO 					}
1651f95d4633SHajimu UMEMOTO 					OPTSET(IN6P_TCLASS);
1652f95d4633SHajimu UMEMOTO 					break;
1653f95d4633SHajimu UMEMOTO 				case IPV6_AUTOFLOWLABEL:
1654f95d4633SHajimu UMEMOTO 					OPTSET(IN6P_AUTOFLOWLABEL);
1655f95d4633SHajimu UMEMOTO 					break;
1656f95d4633SHajimu UMEMOTO 
165782cd038dSYoshinobu Inoue 				}
165833841545SHajimu UMEMOTO 				break;
165933841545SHajimu UMEMOTO 
1660f95d4633SHajimu UMEMOTO 			case IPV6_TCLASS:
1661f95d4633SHajimu UMEMOTO 			case IPV6_DONTFRAG:
1662f95d4633SHajimu UMEMOTO 			case IPV6_USE_MIN_MTU:
1663f95d4633SHajimu UMEMOTO 			case IPV6_PREFER_TEMPADDR:
1664f95d4633SHajimu UMEMOTO 				if (optlen != sizeof(optval)) {
1665f95d4633SHajimu UMEMOTO 					error = EINVAL;
1666f95d4633SHajimu UMEMOTO 					break;
1667f95d4633SHajimu UMEMOTO 				}
1668f95d4633SHajimu UMEMOTO 				error = sooptcopyin(sopt, &optval,
1669f95d4633SHajimu UMEMOTO 					sizeof optval, sizeof optval);
1670f95d4633SHajimu UMEMOTO 				if (error)
1671f95d4633SHajimu UMEMOTO 					break;
1672f95d4633SHajimu UMEMOTO 				{
1673f95d4633SHajimu UMEMOTO 					struct ip6_pktopts **optp;
1674f95d4633SHajimu UMEMOTO 					optp = &in6p->in6p_outputopts;
1675f95d4633SHajimu UMEMOTO 					error = ip6_pcbopt(optname,
1676f95d4633SHajimu UMEMOTO 							   (u_char *)&optval,
1677f95d4633SHajimu UMEMOTO 							   sizeof(optval),
1678f95d4633SHajimu UMEMOTO 							   optp,
1679f95d4633SHajimu UMEMOTO 							   privileged, uproto);
1680f95d4633SHajimu UMEMOTO 					break;
1681f95d4633SHajimu UMEMOTO 				}
1682f95d4633SHajimu UMEMOTO 
1683f95d4633SHajimu UMEMOTO 			case IPV6_2292PKTINFO:
1684f95d4633SHajimu UMEMOTO 			case IPV6_2292HOPLIMIT:
1685f95d4633SHajimu UMEMOTO 			case IPV6_2292HOPOPTS:
1686f95d4633SHajimu UMEMOTO 			case IPV6_2292DSTOPTS:
1687f95d4633SHajimu UMEMOTO 			case IPV6_2292RTHDR:
168833841545SHajimu UMEMOTO 				/* RFC 2292 */
168933841545SHajimu UMEMOTO 				if (optlen != sizeof(int)) {
169033841545SHajimu UMEMOTO 					error = EINVAL;
169133841545SHajimu UMEMOTO 					break;
169233841545SHajimu UMEMOTO 				}
169333841545SHajimu UMEMOTO 				error = sooptcopyin(sopt, &optval,
169433841545SHajimu UMEMOTO 					sizeof optval, sizeof optval);
169533841545SHajimu UMEMOTO 				if (error)
169633841545SHajimu UMEMOTO 					break;
169733841545SHajimu UMEMOTO 				switch (optname) {
1698f95d4633SHajimu UMEMOTO 				case IPV6_2292PKTINFO:
1699f95d4633SHajimu UMEMOTO 					OPTSET2292(IN6P_PKTINFO);
170033841545SHajimu UMEMOTO 					break;
1701f95d4633SHajimu UMEMOTO 				case IPV6_2292HOPLIMIT:
1702f95d4633SHajimu UMEMOTO 					OPTSET2292(IN6P_HOPLIMIT);
170333841545SHajimu UMEMOTO 					break;
1704f95d4633SHajimu UMEMOTO 				case IPV6_2292HOPOPTS:
170533841545SHajimu UMEMOTO 					/*
170633841545SHajimu UMEMOTO 					 * Check super-user privilege.
170733841545SHajimu UMEMOTO 					 * See comments for IPV6_RECVHOPOPTS.
170833841545SHajimu UMEMOTO 					 */
170933841545SHajimu UMEMOTO 					if (!privileged)
171033841545SHajimu UMEMOTO 						return (EPERM);
1711f95d4633SHajimu UMEMOTO 					OPTSET2292(IN6P_HOPOPTS);
171233841545SHajimu UMEMOTO 					break;
1713f95d4633SHajimu UMEMOTO 				case IPV6_2292DSTOPTS:
171433841545SHajimu UMEMOTO 					if (!privileged)
171533841545SHajimu UMEMOTO 						return (EPERM);
1716f95d4633SHajimu UMEMOTO 					OPTSET2292(IN6P_DSTOPTS|IN6P_RTHDRDSTOPTS); /* XXX */
171733841545SHajimu UMEMOTO 					break;
1718f95d4633SHajimu UMEMOTO 				case IPV6_2292RTHDR:
1719f95d4633SHajimu UMEMOTO 					OPTSET2292(IN6P_RTHDR);
172033841545SHajimu UMEMOTO 					break;
172182cd038dSYoshinobu Inoue 				}
172282cd038dSYoshinobu Inoue 				break;
1723f95d4633SHajimu UMEMOTO 			case IPV6_PKTINFO:
1724f95d4633SHajimu UMEMOTO 			case IPV6_HOPOPTS:
1725f95d4633SHajimu UMEMOTO 			case IPV6_RTHDR:
1726f95d4633SHajimu UMEMOTO 			case IPV6_DSTOPTS:
1727f95d4633SHajimu UMEMOTO 			case IPV6_RTHDRDSTOPTS:
1728f95d4633SHajimu UMEMOTO 			case IPV6_NEXTHOP:
1729f95d4633SHajimu UMEMOTO 			{
1730f95d4633SHajimu UMEMOTO 				/* new advanced API (2292bis) */
1731f95d4633SHajimu UMEMOTO 				u_char *optbuf;
1732f95d4633SHajimu UMEMOTO 				int optlen;
1733f95d4633SHajimu UMEMOTO 				struct ip6_pktopts **optp;
1734f95d4633SHajimu UMEMOTO 
1735f95d4633SHajimu UMEMOTO 				/* cannot mix with RFC2292 */
1736f95d4633SHajimu UMEMOTO 				if (OPTBIT(IN6P_RFC2292)) {
1737f95d4633SHajimu UMEMOTO 					error = EINVAL;
1738f95d4633SHajimu UMEMOTO 					break;
1739f95d4633SHajimu UMEMOTO 				}
1740f95d4633SHajimu UMEMOTO 
1741f95d4633SHajimu UMEMOTO 				optbuf = sopt->sopt_val;
1742f95d4633SHajimu UMEMOTO 				optlen = sopt->sopt_valsize;
1743f95d4633SHajimu UMEMOTO 				optp = &in6p->in6p_outputopts;
1744f95d4633SHajimu UMEMOTO 				error = ip6_pcbopt(optname,
1745f95d4633SHajimu UMEMOTO 						   optbuf, optlen,
1746f95d4633SHajimu UMEMOTO 						   optp, privileged, uproto);
1747f95d4633SHajimu UMEMOTO 				break;
1748f95d4633SHajimu UMEMOTO 			}
174982cd038dSYoshinobu Inoue #undef OPTSET
175082cd038dSYoshinobu Inoue 
175182cd038dSYoshinobu Inoue 			case IPV6_MULTICAST_IF:
175282cd038dSYoshinobu Inoue 			case IPV6_MULTICAST_HOPS:
175382cd038dSYoshinobu Inoue 			case IPV6_MULTICAST_LOOP:
175482cd038dSYoshinobu Inoue 			case IPV6_JOIN_GROUP:
175582cd038dSYoshinobu Inoue 			case IPV6_LEAVE_GROUP:
175682cd038dSYoshinobu Inoue 			    {
175782cd038dSYoshinobu Inoue 				if (sopt->sopt_valsize > MLEN) {
175882cd038dSYoshinobu Inoue 					error = EMSGSIZE;
175982cd038dSYoshinobu Inoue 					break;
176082cd038dSYoshinobu Inoue 				}
176182cd038dSYoshinobu Inoue 				/* XXX */
1762f95d4633SHajimu UMEMOTO 			    }
1763f95d4633SHajimu UMEMOTO 			    /* FALLTHROUGH */
1764f95d4633SHajimu UMEMOTO 			    {
1765f95d4633SHajimu UMEMOTO 				struct mbuf *m;
1766f95d4633SHajimu UMEMOTO 
1767f95d4633SHajimu UMEMOTO 				if (sopt->sopt_valsize > MCLBYTES) {
1768f95d4633SHajimu UMEMOTO 					error = EMSGSIZE;
1769f95d4633SHajimu UMEMOTO 					break;
1770f95d4633SHajimu UMEMOTO 				}
1771f95d4633SHajimu UMEMOTO 				/* XXX */
1772f95d4633SHajimu UMEMOTO 				MGET(m, sopt->sopt_td ? M_WAIT : M_DONTWAIT, MT_HEADER);
177382cd038dSYoshinobu Inoue 				if (m == 0) {
177482cd038dSYoshinobu Inoue 					error = ENOBUFS;
177582cd038dSYoshinobu Inoue 					break;
177682cd038dSYoshinobu Inoue 				}
1777f95d4633SHajimu UMEMOTO 				if (sopt->sopt_valsize > MLEN) {
1778f95d4633SHajimu UMEMOTO 					MCLGET(m, sopt->sopt_td ? M_WAIT : M_DONTWAIT);
1779f95d4633SHajimu UMEMOTO 					if ((m->m_flags & M_EXT) == 0) {
1780f95d4633SHajimu UMEMOTO 						m_free(m);
1781f95d4633SHajimu UMEMOTO 						error = ENOBUFS;
1782f95d4633SHajimu UMEMOTO 						break;
1783f95d4633SHajimu UMEMOTO 					}
1784f95d4633SHajimu UMEMOTO 				}
178582cd038dSYoshinobu Inoue 				m->m_len = sopt->sopt_valsize;
178682cd038dSYoshinobu Inoue 				error = sooptcopyin(sopt, mtod(m, char *),
178782cd038dSYoshinobu Inoue 						    m->m_len, m->m_len);
1788f95d4633SHajimu UMEMOTO 				if (error) {
1789f95d4633SHajimu UMEMOTO 					(void)m_free(m);
1790f95d4633SHajimu UMEMOTO 					break;
1791f95d4633SHajimu UMEMOTO 				}
179282cd038dSYoshinobu Inoue 				error =	ip6_setmoptions(sopt->sopt_name,
179382cd038dSYoshinobu Inoue 							&in6p->in6p_moptions,
179482cd038dSYoshinobu Inoue 							m);
179582cd038dSYoshinobu Inoue 				(void)m_free(m);
179682cd038dSYoshinobu Inoue 			    }
179782cd038dSYoshinobu Inoue 				break;
179882cd038dSYoshinobu Inoue 
179982cd038dSYoshinobu Inoue 			case IPV6_PORTRANGE:
1800686cdd19SJun-ichiro itojun Hagino 				error = sooptcopyin(sopt, &optval,
1801686cdd19SJun-ichiro itojun Hagino 				    sizeof optval, sizeof optval);
180282cd038dSYoshinobu Inoue 				if (error)
180382cd038dSYoshinobu Inoue 					break;
180482cd038dSYoshinobu Inoue 
180582cd038dSYoshinobu Inoue 				switch (optval) {
180682cd038dSYoshinobu Inoue 				case IPV6_PORTRANGE_DEFAULT:
180782cd038dSYoshinobu Inoue 					in6p->in6p_flags &= ~(IN6P_LOWPORT);
180882cd038dSYoshinobu Inoue 					in6p->in6p_flags &= ~(IN6P_HIGHPORT);
180982cd038dSYoshinobu Inoue 					break;
181082cd038dSYoshinobu Inoue 
181182cd038dSYoshinobu Inoue 				case IPV6_PORTRANGE_HIGH:
181282cd038dSYoshinobu Inoue 					in6p->in6p_flags &= ~(IN6P_LOWPORT);
181382cd038dSYoshinobu Inoue 					in6p->in6p_flags |= IN6P_HIGHPORT;
181482cd038dSYoshinobu Inoue 					break;
181582cd038dSYoshinobu Inoue 
181682cd038dSYoshinobu Inoue 				case IPV6_PORTRANGE_LOW:
181782cd038dSYoshinobu Inoue 					in6p->in6p_flags &= ~(IN6P_HIGHPORT);
181882cd038dSYoshinobu Inoue 					in6p->in6p_flags |= IN6P_LOWPORT;
181982cd038dSYoshinobu Inoue 					break;
182082cd038dSYoshinobu Inoue 
182182cd038dSYoshinobu Inoue 				default:
182282cd038dSYoshinobu Inoue 					error = EINVAL;
182382cd038dSYoshinobu Inoue 					break;
182482cd038dSYoshinobu Inoue 				}
182582cd038dSYoshinobu Inoue 				break;
182682cd038dSYoshinobu Inoue 
1827b9234fafSSam Leffler #if defined(IPSEC) || defined(FAST_IPSEC)
182882cd038dSYoshinobu Inoue 			case IPV6_IPSEC_POLICY:
182982cd038dSYoshinobu Inoue 			    {
183082cd038dSYoshinobu Inoue 				caddr_t req = NULL;
1831686cdd19SJun-ichiro itojun Hagino 				size_t len = 0;
183282cd038dSYoshinobu Inoue 				struct mbuf *m;
183382cd038dSYoshinobu Inoue 
1834686cdd19SJun-ichiro itojun Hagino 				if ((error = soopt_getm(sopt, &m)) != 0) /* XXX */
183582cd038dSYoshinobu Inoue 					break;
1836686cdd19SJun-ichiro itojun Hagino 				if ((error = soopt_mcopyin(sopt, m)) != 0) /* XXX */
183782cd038dSYoshinobu Inoue 					break;
1838686cdd19SJun-ichiro itojun Hagino 				if (m) {
183982cd038dSYoshinobu Inoue 					req = mtod(m, caddr_t);
1840686cdd19SJun-ichiro itojun Hagino 					len = m->m_len;
1841686cdd19SJun-ichiro itojun Hagino 				}
184282cd038dSYoshinobu Inoue 				error = ipsec6_set_policy(in6p, optname, req,
1843686cdd19SJun-ichiro itojun Hagino 							  len, privileged);
184482cd038dSYoshinobu Inoue 				m_freem(m);
184582cd038dSYoshinobu Inoue 			    }
184682cd038dSYoshinobu Inoue 				break;
184733841545SHajimu UMEMOTO #endif /* KAME IPSEC */
184882cd038dSYoshinobu Inoue 
184982cd038dSYoshinobu Inoue 			case IPV6_FW_ADD:
185082cd038dSYoshinobu Inoue 			case IPV6_FW_DEL:
185182cd038dSYoshinobu Inoue 			case IPV6_FW_FLUSH:
185282cd038dSYoshinobu Inoue 			case IPV6_FW_ZERO:
185382cd038dSYoshinobu Inoue 			    {
185482cd038dSYoshinobu Inoue 				struct mbuf *m;
185582cd038dSYoshinobu Inoue 				struct mbuf **mp = &m;
185682cd038dSYoshinobu Inoue 
185782cd038dSYoshinobu Inoue 				if (ip6_fw_ctl_ptr == NULL)
185882cd038dSYoshinobu Inoue 					return EINVAL;
18593e617560SHajimu UMEMOTO 				/* XXX */
18603e617560SHajimu UMEMOTO 				if ((error = soopt_getm(sopt, &m)) != 0)
186182cd038dSYoshinobu Inoue 					break;
18623e617560SHajimu UMEMOTO 				/* XXX */
18633e617560SHajimu UMEMOTO 				if ((error = soopt_mcopyin(sopt, m)) != 0)
186482cd038dSYoshinobu Inoue 					break;
186582cd038dSYoshinobu Inoue 				error = (*ip6_fw_ctl_ptr)(optname, mp);
186682cd038dSYoshinobu Inoue 				m = *mp;
186782cd038dSYoshinobu Inoue 			    }
186882cd038dSYoshinobu Inoue 				break;
186982cd038dSYoshinobu Inoue 
187082cd038dSYoshinobu Inoue 			default:
187182cd038dSYoshinobu Inoue 				error = ENOPROTOOPT;
187282cd038dSYoshinobu Inoue 				break;
187382cd038dSYoshinobu Inoue 			}
187482cd038dSYoshinobu Inoue 			break;
187582cd038dSYoshinobu Inoue 
187682cd038dSYoshinobu Inoue 		case SOPT_GET:
187782cd038dSYoshinobu Inoue 			switch (optname) {
187882cd038dSYoshinobu Inoue 
1879f95d4633SHajimu UMEMOTO 			case IPV6_2292PKTOPTIONS:
1880f95d4633SHajimu UMEMOTO #ifdef IPV6_PKTOPTIONS
188182cd038dSYoshinobu Inoue 			case IPV6_PKTOPTIONS:
1882f95d4633SHajimu UMEMOTO #endif
1883f95d4633SHajimu UMEMOTO 				/*
1884f95d4633SHajimu UMEMOTO 				 * RFC3542 (effectively) deprecated the
1885f95d4633SHajimu UMEMOTO 				 * semantics of the 2292-style pktoptions.
1886f95d4633SHajimu UMEMOTO 				 * Since it was not reliable in nature (i.e.,
1887f95d4633SHajimu UMEMOTO 				 * applications had to expect the lack of some
1888f95d4633SHajimu UMEMOTO 				 * information after all), it would make sense
1889f95d4633SHajimu UMEMOTO 				 * to simplify this part by always returning
1890f95d4633SHajimu UMEMOTO 				 * empty data.
1891f95d4633SHajimu UMEMOTO 				 */
189282cd038dSYoshinobu Inoue 				sopt->sopt_valsize = 0;
189382cd038dSYoshinobu Inoue 				break;
189482cd038dSYoshinobu Inoue 
1895f95d4633SHajimu UMEMOTO 			case IPV6_RECVHOPOPTS:
1896f95d4633SHajimu UMEMOTO 			case IPV6_RECVDSTOPTS:
1897f95d4633SHajimu UMEMOTO 			case IPV6_RECVRTHDRDSTOPTS:
189882cd038dSYoshinobu Inoue 			case IPV6_UNICAST_HOPS:
1899f95d4633SHajimu UMEMOTO 			case IPV6_RECVPKTINFO:
1900f95d4633SHajimu UMEMOTO 			case IPV6_RECVHOPLIMIT:
1901f95d4633SHajimu UMEMOTO 			case IPV6_RECVRTHDR:
1902f95d4633SHajimu UMEMOTO 			case IPV6_RECVPATHMTU:
190333841545SHajimu UMEMOTO 
190482cd038dSYoshinobu Inoue 			case IPV6_FAITH:
190533841545SHajimu UMEMOTO 			case IPV6_V6ONLY:
1906fa310a7eSYoshinobu Inoue 			case IPV6_PORTRANGE:
1907f95d4633SHajimu UMEMOTO 			case IPV6_RECVTCLASS:
1908f95d4633SHajimu UMEMOTO 			case IPV6_AUTOFLOWLABEL:
190982cd038dSYoshinobu Inoue 				switch (optname) {
191082cd038dSYoshinobu Inoue 
1911f95d4633SHajimu UMEMOTO 				case IPV6_RECVHOPOPTS:
1912f95d4633SHajimu UMEMOTO 					optval = OPTBIT(IN6P_HOPOPTS);
1913f95d4633SHajimu UMEMOTO 					break;
1914f95d4633SHajimu UMEMOTO 
1915f95d4633SHajimu UMEMOTO 				case IPV6_RECVDSTOPTS:
1916f95d4633SHajimu UMEMOTO 					optval = OPTBIT(IN6P_DSTOPTS);
1917f95d4633SHajimu UMEMOTO 					break;
1918f95d4633SHajimu UMEMOTO 
1919f95d4633SHajimu UMEMOTO 				case IPV6_RECVRTHDRDSTOPTS:
1920f95d4633SHajimu UMEMOTO 					optval = OPTBIT(IN6P_RTHDRDSTOPTS);
1921f95d4633SHajimu UMEMOTO 					break;
1922f95d4633SHajimu UMEMOTO 
192382cd038dSYoshinobu Inoue 				case IPV6_UNICAST_HOPS:
192482cd038dSYoshinobu Inoue 					optval = in6p->in6p_hops;
192582cd038dSYoshinobu Inoue 					break;
192682cd038dSYoshinobu Inoue 
1927f95d4633SHajimu UMEMOTO 				case IPV6_RECVPKTINFO:
1928f95d4633SHajimu UMEMOTO 					optval = OPTBIT(IN6P_PKTINFO);
1929f95d4633SHajimu UMEMOTO 					break;
1930f95d4633SHajimu UMEMOTO 
1931f95d4633SHajimu UMEMOTO 				case IPV6_RECVHOPLIMIT:
1932f95d4633SHajimu UMEMOTO 					optval = OPTBIT(IN6P_HOPLIMIT);
1933f95d4633SHajimu UMEMOTO 					break;
1934f95d4633SHajimu UMEMOTO 
1935f95d4633SHajimu UMEMOTO 				case IPV6_RECVRTHDR:
1936f95d4633SHajimu UMEMOTO 					optval = OPTBIT(IN6P_RTHDR);
1937f95d4633SHajimu UMEMOTO 					break;
1938f95d4633SHajimu UMEMOTO 
1939f95d4633SHajimu UMEMOTO 				case IPV6_RECVPATHMTU:
1940f95d4633SHajimu UMEMOTO 					optval = OPTBIT(IN6P_MTU);
194182cd038dSYoshinobu Inoue 					break;
194282cd038dSYoshinobu Inoue 
194382cd038dSYoshinobu Inoue 				case IPV6_FAITH:
194482cd038dSYoshinobu Inoue 					optval = OPTBIT(IN6P_FAITH);
194582cd038dSYoshinobu Inoue 					break;
194682cd038dSYoshinobu Inoue 
194733841545SHajimu UMEMOTO 				case IPV6_V6ONLY:
1948854d3b19SHajimu UMEMOTO 					optval = OPTBIT(IN6P_IPV6_V6ONLY);
194982cd038dSYoshinobu Inoue 					break;
195082cd038dSYoshinobu Inoue 
195182cd038dSYoshinobu Inoue 				case IPV6_PORTRANGE:
195282cd038dSYoshinobu Inoue 				    {
195382cd038dSYoshinobu Inoue 					int flags;
195482cd038dSYoshinobu Inoue 					flags = in6p->in6p_flags;
195582cd038dSYoshinobu Inoue 					if (flags & IN6P_HIGHPORT)
195682cd038dSYoshinobu Inoue 						optval = IPV6_PORTRANGE_HIGH;
195782cd038dSYoshinobu Inoue 					else if (flags & IN6P_LOWPORT)
195882cd038dSYoshinobu Inoue 						optval = IPV6_PORTRANGE_LOW;
195982cd038dSYoshinobu Inoue 					else
196082cd038dSYoshinobu Inoue 						optval = 0;
196182cd038dSYoshinobu Inoue 					break;
196282cd038dSYoshinobu Inoue 				    }
1963f95d4633SHajimu UMEMOTO 				case IPV6_RECVTCLASS:
1964f95d4633SHajimu UMEMOTO 					optval = OPTBIT(IN6P_TCLASS);
1965f95d4633SHajimu UMEMOTO 					break;
1966f95d4633SHajimu UMEMOTO 
1967f95d4633SHajimu UMEMOTO 				case IPV6_AUTOFLOWLABEL:
1968f95d4633SHajimu UMEMOTO 					optval = OPTBIT(IN6P_AUTOFLOWLABEL);
1969f95d4633SHajimu UMEMOTO 					break;
197082cd038dSYoshinobu Inoue 				}
1971f95d4633SHajimu UMEMOTO 				if (error)
1972f95d4633SHajimu UMEMOTO 					break;
197382cd038dSYoshinobu Inoue 				error = sooptcopyout(sopt, &optval,
197482cd038dSYoshinobu Inoue 					sizeof optval);
197582cd038dSYoshinobu Inoue 				break;
197682cd038dSYoshinobu Inoue 
1977f95d4633SHajimu UMEMOTO 			case IPV6_PATHMTU:
1978f95d4633SHajimu UMEMOTO 			{
1979f95d4633SHajimu UMEMOTO 				u_long pmtu = 0;
1980f95d4633SHajimu UMEMOTO 				struct ip6_mtuinfo mtuinfo;
1981f95d4633SHajimu UMEMOTO 				struct route_in6 *ro = (struct route_in6 *)&in6p->in6p_route;
1982f95d4633SHajimu UMEMOTO 
1983f95d4633SHajimu UMEMOTO 				if (!(so->so_state & SS_ISCONNECTED))
1984f95d4633SHajimu UMEMOTO 					return (ENOTCONN);
1985f95d4633SHajimu UMEMOTO 				/*
1986f95d4633SHajimu UMEMOTO 				 * XXX: we dot not consider the case of source
1987f95d4633SHajimu UMEMOTO 				 * routing, or optional information to specify
1988f95d4633SHajimu UMEMOTO 				 * the outgoing interface.
1989f95d4633SHajimu UMEMOTO 				 */
1990f95d4633SHajimu UMEMOTO 				error = ip6_getpmtu(ro, NULL, NULL,
1991f95d4633SHajimu UMEMOTO 				    &in6p->in6p_faddr, &pmtu, NULL);
1992f95d4633SHajimu UMEMOTO 				if (error)
1993f95d4633SHajimu UMEMOTO 					break;
1994f95d4633SHajimu UMEMOTO 				if (pmtu > IPV6_MAXPACKET)
1995f95d4633SHajimu UMEMOTO 					pmtu = IPV6_MAXPACKET;
1996f95d4633SHajimu UMEMOTO 
1997f95d4633SHajimu UMEMOTO 				bzero(&mtuinfo, sizeof(mtuinfo));
1998f95d4633SHajimu UMEMOTO 				mtuinfo.ip6m_mtu = (u_int32_t)pmtu;
1999f95d4633SHajimu UMEMOTO 				optdata = (void *)&mtuinfo;
2000f95d4633SHajimu UMEMOTO 				optdatalen = sizeof(mtuinfo);
2001f95d4633SHajimu UMEMOTO 				error = sooptcopyout(sopt, optdata,
2002f95d4633SHajimu UMEMOTO 				    optdatalen);
2003f95d4633SHajimu UMEMOTO 				break;
2004f95d4633SHajimu UMEMOTO 			}
2005f95d4633SHajimu UMEMOTO 
2006f95d4633SHajimu UMEMOTO 			case IPV6_2292PKTINFO:
2007f95d4633SHajimu UMEMOTO 			case IPV6_2292HOPLIMIT:
2008f95d4633SHajimu UMEMOTO 			case IPV6_2292HOPOPTS:
2009f95d4633SHajimu UMEMOTO 			case IPV6_2292RTHDR:
2010f95d4633SHajimu UMEMOTO 			case IPV6_2292DSTOPTS:
201133841545SHajimu UMEMOTO 				switch (optname) {
2012f95d4633SHajimu UMEMOTO 				case IPV6_2292PKTINFO:
201333841545SHajimu UMEMOTO 					optval = OPTBIT(IN6P_PKTINFO);
201433841545SHajimu UMEMOTO 					break;
2015f95d4633SHajimu UMEMOTO 				case IPV6_2292HOPLIMIT:
201633841545SHajimu UMEMOTO 					optval = OPTBIT(IN6P_HOPLIMIT);
201733841545SHajimu UMEMOTO 					break;
2018f95d4633SHajimu UMEMOTO 				case IPV6_2292HOPOPTS:
201933841545SHajimu UMEMOTO 					optval = OPTBIT(IN6P_HOPOPTS);
202033841545SHajimu UMEMOTO 					break;
2021f95d4633SHajimu UMEMOTO 				case IPV6_2292RTHDR:
202233841545SHajimu UMEMOTO 					optval = OPTBIT(IN6P_RTHDR);
202333841545SHajimu UMEMOTO 					break;
2024f95d4633SHajimu UMEMOTO 				case IPV6_2292DSTOPTS:
202533841545SHajimu UMEMOTO 					optval = OPTBIT(IN6P_DSTOPTS|IN6P_RTHDRDSTOPTS);
202633841545SHajimu UMEMOTO 					break;
202733841545SHajimu UMEMOTO 				}
202833841545SHajimu UMEMOTO 				error = sooptcopyout(sopt, &optval,
202933841545SHajimu UMEMOTO 				    sizeof optval);
203033841545SHajimu UMEMOTO 				break;
2031f95d4633SHajimu UMEMOTO 			case IPV6_PKTINFO:
2032f95d4633SHajimu UMEMOTO 			case IPV6_HOPOPTS:
2033f95d4633SHajimu UMEMOTO 			case IPV6_RTHDR:
2034f95d4633SHajimu UMEMOTO 			case IPV6_DSTOPTS:
2035f95d4633SHajimu UMEMOTO 			case IPV6_RTHDRDSTOPTS:
2036f95d4633SHajimu UMEMOTO 			case IPV6_NEXTHOP:
2037f95d4633SHajimu UMEMOTO 			case IPV6_TCLASS:
2038f95d4633SHajimu UMEMOTO 			case IPV6_DONTFRAG:
2039f95d4633SHajimu UMEMOTO 			case IPV6_USE_MIN_MTU:
2040f95d4633SHajimu UMEMOTO 			case IPV6_PREFER_TEMPADDR:
2041f95d4633SHajimu UMEMOTO 				error = ip6_getpcbopt(in6p->in6p_outputopts,
2042f95d4633SHajimu UMEMOTO 				    optname, sopt);
2043f95d4633SHajimu UMEMOTO 				break;
204433841545SHajimu UMEMOTO 
204582cd038dSYoshinobu Inoue 			case IPV6_MULTICAST_IF:
204682cd038dSYoshinobu Inoue 			case IPV6_MULTICAST_HOPS:
204782cd038dSYoshinobu Inoue 			case IPV6_MULTICAST_LOOP:
204882cd038dSYoshinobu Inoue 			case IPV6_JOIN_GROUP:
204982cd038dSYoshinobu Inoue 			case IPV6_LEAVE_GROUP:
205082cd038dSYoshinobu Inoue 			    {
205182cd038dSYoshinobu Inoue 				struct mbuf *m;
205282cd038dSYoshinobu Inoue 				error = ip6_getmoptions(sopt->sopt_name,
205382cd038dSYoshinobu Inoue 				    in6p->in6p_moptions, &m);
205482cd038dSYoshinobu Inoue 				if (error == 0)
205582cd038dSYoshinobu Inoue 					error = sooptcopyout(sopt,
205682cd038dSYoshinobu Inoue 					    mtod(m, char *), m->m_len);
205782cd038dSYoshinobu Inoue 				m_freem(m);
205882cd038dSYoshinobu Inoue 			    }
205982cd038dSYoshinobu Inoue 				break;
206082cd038dSYoshinobu Inoue 
2061b9234fafSSam Leffler #if defined(IPSEC) || defined(FAST_IPSEC)
206282cd038dSYoshinobu Inoue 			case IPV6_IPSEC_POLICY:
206382cd038dSYoshinobu Inoue 			  {
2064f63e7634SYoshinobu Inoue 				caddr_t req = NULL;
2065686cdd19SJun-ichiro itojun Hagino 				size_t len = 0;
2066686cdd19SJun-ichiro itojun Hagino 				struct mbuf *m = NULL;
2067686cdd19SJun-ichiro itojun Hagino 				struct mbuf **mp = &m;
2068f95d4633SHajimu UMEMOTO 				size_t ovalsize = sopt->sopt_valsize;
2069f95d4633SHajimu UMEMOTO 				caddr_t oval = (caddr_t)sopt->sopt_val;
2070f63e7634SYoshinobu Inoue 
2071686cdd19SJun-ichiro itojun Hagino 				error = soopt_getm(sopt, &m); /* XXX */
20727efe5d92SHajimu UMEMOTO 				if (error != NULL)
2073686cdd19SJun-ichiro itojun Hagino 					break;
2074686cdd19SJun-ichiro itojun Hagino 				error = soopt_mcopyin(sopt, m); /* XXX */
20757efe5d92SHajimu UMEMOTO 				if (error != NULL)
2076686cdd19SJun-ichiro itojun Hagino 					break;
2077f95d4633SHajimu UMEMOTO 				sopt->sopt_valsize = ovalsize;
2078f95d4633SHajimu UMEMOTO 				sopt->sopt_val = oval;
2079686cdd19SJun-ichiro itojun Hagino 				if (m) {
208082cd038dSYoshinobu Inoue 					req = mtod(m, caddr_t);
2081686cdd19SJun-ichiro itojun Hagino 					len = m->m_len;
2082686cdd19SJun-ichiro itojun Hagino 				}
2083686cdd19SJun-ichiro itojun Hagino 				error = ipsec6_get_policy(in6p, req, len, mp);
208482cd038dSYoshinobu Inoue 				if (error == 0)
208582cd038dSYoshinobu Inoue 					error = soopt_mcopyout(sopt, m); /* XXX */
208633841545SHajimu UMEMOTO 				if (error == 0 && m)
208782cd038dSYoshinobu Inoue 					m_freem(m);
208882cd038dSYoshinobu Inoue 				break;
208982cd038dSYoshinobu Inoue 			  }
209033841545SHajimu UMEMOTO #endif /* KAME IPSEC */
209182cd038dSYoshinobu Inoue 
209282cd038dSYoshinobu Inoue 			case IPV6_FW_GET:
209382cd038dSYoshinobu Inoue 			  {
209482cd038dSYoshinobu Inoue 				struct mbuf *m;
209582cd038dSYoshinobu Inoue 				struct mbuf **mp = &m;
209682cd038dSYoshinobu Inoue 
209782cd038dSYoshinobu Inoue 				if (ip6_fw_ctl_ptr == NULL)
209882cd038dSYoshinobu Inoue 			        {
209982cd038dSYoshinobu Inoue 					return EINVAL;
210082cd038dSYoshinobu Inoue 				}
210182cd038dSYoshinobu Inoue 				error = (*ip6_fw_ctl_ptr)(optname, mp);
210282cd038dSYoshinobu Inoue 				if (error == 0)
210382cd038dSYoshinobu Inoue 					error = soopt_mcopyout(sopt, m); /* XXX */
21046c0bea35SHajimu UMEMOTO 				if (error == 0 && m)
210582cd038dSYoshinobu Inoue 					m_freem(m);
210682cd038dSYoshinobu Inoue 			  }
210782cd038dSYoshinobu Inoue 				break;
210882cd038dSYoshinobu Inoue 
210982cd038dSYoshinobu Inoue 			default:
211082cd038dSYoshinobu Inoue 				error = ENOPROTOOPT;
211182cd038dSYoshinobu Inoue 				break;
211282cd038dSYoshinobu Inoue 			}
211382cd038dSYoshinobu Inoue 			break;
211482cd038dSYoshinobu Inoue 		}
2115f95d4633SHajimu UMEMOTO 	} else {		/* level != IPPROTO_IPV6 */
211682cd038dSYoshinobu Inoue 		error = EINVAL;
211782cd038dSYoshinobu Inoue 	}
211882cd038dSYoshinobu Inoue 	return (error);
211982cd038dSYoshinobu Inoue }
212082cd038dSYoshinobu Inoue 
212102b9a206SHajimu UMEMOTO int
212202b9a206SHajimu UMEMOTO ip6_raw_ctloutput(so, sopt)
212302b9a206SHajimu UMEMOTO 	struct socket *so;
212402b9a206SHajimu UMEMOTO 	struct sockopt *sopt;
212502b9a206SHajimu UMEMOTO {
212602b9a206SHajimu UMEMOTO 	int error = 0, optval, optlen;
212702b9a206SHajimu UMEMOTO 	const int icmp6off = offsetof(struct icmp6_hdr, icmp6_cksum);
212802b9a206SHajimu UMEMOTO 	struct in6pcb *in6p = sotoin6pcb(so);
212902b9a206SHajimu UMEMOTO 	int level, op, optname;
213002b9a206SHajimu UMEMOTO 
213102b9a206SHajimu UMEMOTO 	if (sopt) {
213202b9a206SHajimu UMEMOTO 		level = sopt->sopt_level;
213302b9a206SHajimu UMEMOTO 		op = sopt->sopt_dir;
213402b9a206SHajimu UMEMOTO 		optname = sopt->sopt_name;
213502b9a206SHajimu UMEMOTO 		optlen = sopt->sopt_valsize;
213602b9a206SHajimu UMEMOTO 	} else
213702b9a206SHajimu UMEMOTO 		panic("ip6_raw_ctloutput: arg soopt is NULL");
213802b9a206SHajimu UMEMOTO 
213902b9a206SHajimu UMEMOTO 	if (level != IPPROTO_IPV6) {
214002b9a206SHajimu UMEMOTO 		return (EINVAL);
214102b9a206SHajimu UMEMOTO 	}
214202b9a206SHajimu UMEMOTO 
214302b9a206SHajimu UMEMOTO 	switch (optname) {
214402b9a206SHajimu UMEMOTO 	case IPV6_CHECKSUM:
214502b9a206SHajimu UMEMOTO 		/*
214602b9a206SHajimu UMEMOTO 		 * For ICMPv6 sockets, no modification allowed for checksum
214702b9a206SHajimu UMEMOTO 		 * offset, permit "no change" values to help existing apps.
214802b9a206SHajimu UMEMOTO 		 *
214902b9a206SHajimu UMEMOTO 		 * XXX 2292bis says: "An attempt to set IPV6_CHECKSUM
215002b9a206SHajimu UMEMOTO 		 * for an ICMPv6 socket will fail."
215102b9a206SHajimu UMEMOTO 		 * The current behavior does not meet 2292bis.
215202b9a206SHajimu UMEMOTO 		 */
215302b9a206SHajimu UMEMOTO 		switch (op) {
215402b9a206SHajimu UMEMOTO 		case SOPT_SET:
215502b9a206SHajimu UMEMOTO 			if (optlen != sizeof(int)) {
215602b9a206SHajimu UMEMOTO 				error = EINVAL;
215702b9a206SHajimu UMEMOTO 				break;
215802b9a206SHajimu UMEMOTO 			}
215902b9a206SHajimu UMEMOTO 			error = sooptcopyin(sopt, &optval, sizeof(optval),
216002b9a206SHajimu UMEMOTO 					    sizeof(optval));
216102b9a206SHajimu UMEMOTO 			if (error)
216202b9a206SHajimu UMEMOTO 				break;
216302b9a206SHajimu UMEMOTO 			if ((optval % 2) != 0) {
216402b9a206SHajimu UMEMOTO 				/* the API assumes even offset values */
216502b9a206SHajimu UMEMOTO 				error = EINVAL;
216602b9a206SHajimu UMEMOTO 			} else if (so->so_proto->pr_protocol ==
216702b9a206SHajimu UMEMOTO 			    IPPROTO_ICMPV6) {
216802b9a206SHajimu UMEMOTO 				if (optval != icmp6off)
216902b9a206SHajimu UMEMOTO 					error = EINVAL;
217002b9a206SHajimu UMEMOTO 			} else
217102b9a206SHajimu UMEMOTO 				in6p->in6p_cksum = optval;
217202b9a206SHajimu UMEMOTO 			break;
217302b9a206SHajimu UMEMOTO 
217402b9a206SHajimu UMEMOTO 		case SOPT_GET:
217502b9a206SHajimu UMEMOTO 			if (so->so_proto->pr_protocol == IPPROTO_ICMPV6)
217602b9a206SHajimu UMEMOTO 				optval = icmp6off;
217702b9a206SHajimu UMEMOTO 			else
217802b9a206SHajimu UMEMOTO 				optval = in6p->in6p_cksum;
217902b9a206SHajimu UMEMOTO 
218002b9a206SHajimu UMEMOTO 			error = sooptcopyout(sopt, &optval, sizeof(optval));
218102b9a206SHajimu UMEMOTO 			break;
218202b9a206SHajimu UMEMOTO 
218302b9a206SHajimu UMEMOTO 		default:
218402b9a206SHajimu UMEMOTO 			error = EINVAL;
218502b9a206SHajimu UMEMOTO 			break;
218602b9a206SHajimu UMEMOTO 		}
218702b9a206SHajimu UMEMOTO 		break;
218802b9a206SHajimu UMEMOTO 
218902b9a206SHajimu UMEMOTO 	default:
219002b9a206SHajimu UMEMOTO 		error = ENOPROTOOPT;
219102b9a206SHajimu UMEMOTO 		break;
219202b9a206SHajimu UMEMOTO 	}
219302b9a206SHajimu UMEMOTO 
219402b9a206SHajimu UMEMOTO 	return (error);
219502b9a206SHajimu UMEMOTO }
219602b9a206SHajimu UMEMOTO 
219782cd038dSYoshinobu Inoue /*
219833841545SHajimu UMEMOTO  * Set up IP6 options in pcb for insertion in output packets or
219933841545SHajimu UMEMOTO  * specifying behavior of outgoing packets.
220082cd038dSYoshinobu Inoue  */
220182cd038dSYoshinobu Inoue static int
220282cd038dSYoshinobu Inoue ip6_pcbopts(pktopt, m, so, sopt)
220382cd038dSYoshinobu Inoue 	struct ip6_pktopts **pktopt;
220433841545SHajimu UMEMOTO 	struct mbuf *m;
220582cd038dSYoshinobu Inoue 	struct socket *so;
220682cd038dSYoshinobu Inoue 	struct sockopt *sopt;
220782cd038dSYoshinobu Inoue {
220833841545SHajimu UMEMOTO 	struct ip6_pktopts *opt = *pktopt;
220982cd038dSYoshinobu Inoue 	int error = 0;
2210b40ce416SJulian Elischer 	struct thread *td = sopt->sopt_td;
221182cd038dSYoshinobu Inoue 	int priv = 0;
221282cd038dSYoshinobu Inoue 
221382cd038dSYoshinobu Inoue 	/* turn off any old options. */
221482cd038dSYoshinobu Inoue 	if (opt) {
221533841545SHajimu UMEMOTO #ifdef DIAGNOSTIC
221633841545SHajimu UMEMOTO 		if (opt->ip6po_pktinfo || opt->ip6po_nexthop ||
221733841545SHajimu UMEMOTO 		    opt->ip6po_hbh || opt->ip6po_dest1 || opt->ip6po_dest2 ||
221833841545SHajimu UMEMOTO 		    opt->ip6po_rhinfo.ip6po_rhi_rthdr)
221933841545SHajimu UMEMOTO 			printf("ip6_pcbopts: all specified options are cleared.\n");
222033841545SHajimu UMEMOTO #endif
2221f95d4633SHajimu UMEMOTO 		ip6_clearpktopts(opt, -1);
222282cd038dSYoshinobu Inoue 	} else
2223a163d034SWarner Losh 		opt = malloc(sizeof(*opt), M_IP6OPT, M_WAITOK);
222433841545SHajimu UMEMOTO 	*pktopt = NULL;
222582cd038dSYoshinobu Inoue 
222682cd038dSYoshinobu Inoue 	if (!m || m->m_len == 0) {
222782cd038dSYoshinobu Inoue 		/*
222835f6695bSHajimu UMEMOTO 		 * Only turning off any previous options, regardless of
222935f6695bSHajimu UMEMOTO 		 * whether the opt is just created or given.
223082cd038dSYoshinobu Inoue 		 */
223182cd038dSYoshinobu Inoue 		free(opt, M_IP6OPT);
223282cd038dSYoshinobu Inoue 		return (0);
223382cd038dSYoshinobu Inoue 	}
223482cd038dSYoshinobu Inoue 
223582cd038dSYoshinobu Inoue 	/*  set options specified by user. */
223644731cabSJohn Baldwin 	if (td && !suser(td))
223782cd038dSYoshinobu Inoue 		priv = 1;
2238f95d4633SHajimu UMEMOTO 	if ((error = ip6_setpktoptions(m, opt, NULL, priv, 1,
2239f95d4633SHajimu UMEMOTO 	    so->so_proto->pr_protocol)) != 0) {
2240f95d4633SHajimu UMEMOTO 		ip6_clearpktopts(opt, -1); /* XXX: discard all options */
224135f6695bSHajimu UMEMOTO 		free(opt, M_IP6OPT);
224282cd038dSYoshinobu Inoue 		return (error);
224382cd038dSYoshinobu Inoue 	}
224482cd038dSYoshinobu Inoue 	*pktopt = opt;
224582cd038dSYoshinobu Inoue 	return (0);
224682cd038dSYoshinobu Inoue }
224782cd038dSYoshinobu Inoue 
224882cd038dSYoshinobu Inoue /*
224933841545SHajimu UMEMOTO  * initialize ip6_pktopts.  beware that there are non-zero default values in
225033841545SHajimu UMEMOTO  * the struct.
225133841545SHajimu UMEMOTO  */
225233841545SHajimu UMEMOTO void
225333841545SHajimu UMEMOTO init_ip6pktopts(opt)
225433841545SHajimu UMEMOTO 	struct ip6_pktopts *opt;
225533841545SHajimu UMEMOTO {
225633841545SHajimu UMEMOTO 
225733841545SHajimu UMEMOTO 	bzero(opt, sizeof(*opt));
225833841545SHajimu UMEMOTO 	opt->ip6po_hlim = -1;	/* -1 means default hop limit */
2259f95d4633SHajimu UMEMOTO 	opt->ip6po_tclass = -1;	/* -1 means default traffic class */
2260f95d4633SHajimu UMEMOTO 	opt->ip6po_minmtu = IP6PO_MINMTU_MCASTONLY;
2261f95d4633SHajimu UMEMOTO 	opt->ip6po_prefer_tempaddr = IP6PO_TEMPADDR_SYSTEM;
2262f95d4633SHajimu UMEMOTO }
2263f95d4633SHajimu UMEMOTO 
2264f95d4633SHajimu UMEMOTO static int
2265f95d4633SHajimu UMEMOTO ip6_pcbopt(optname, buf, len, pktopt, priv, uproto)
2266f95d4633SHajimu UMEMOTO 	int optname, len, priv;
2267f95d4633SHajimu UMEMOTO 	u_char *buf;
2268f95d4633SHajimu UMEMOTO 	struct ip6_pktopts **pktopt;
2269f95d4633SHajimu UMEMOTO 	int uproto;
2270f95d4633SHajimu UMEMOTO {
2271f95d4633SHajimu UMEMOTO 	struct ip6_pktopts *opt;
2272f95d4633SHajimu UMEMOTO 
2273f95d4633SHajimu UMEMOTO 	if (*pktopt == NULL) {
2274f95d4633SHajimu UMEMOTO 		*pktopt = malloc(sizeof(struct ip6_pktopts), M_IP6OPT,
2275f95d4633SHajimu UMEMOTO 		    M_WAITOK);
2276f95d4633SHajimu UMEMOTO 		init_ip6pktopts(*pktopt);
2277f95d4633SHajimu UMEMOTO 		(*pktopt)->needfree = 1;
2278f95d4633SHajimu UMEMOTO 	}
2279f95d4633SHajimu UMEMOTO 	opt = *pktopt;
2280f95d4633SHajimu UMEMOTO 
2281f95d4633SHajimu UMEMOTO 	return (ip6_setpktoption(optname, buf, len, opt, priv, 1, 0, uproto));
2282f95d4633SHajimu UMEMOTO }
2283f95d4633SHajimu UMEMOTO 
2284f95d4633SHajimu UMEMOTO static int
2285f95d4633SHajimu UMEMOTO ip6_getpcbopt(pktopt, optname, sopt)
2286f95d4633SHajimu UMEMOTO 	struct ip6_pktopts *pktopt;
2287f95d4633SHajimu UMEMOTO 	struct sockopt *sopt;
2288f95d4633SHajimu UMEMOTO 	int optname;
2289f95d4633SHajimu UMEMOTO {
2290f95d4633SHajimu UMEMOTO 	void *optdata = NULL;
2291f95d4633SHajimu UMEMOTO 	int optdatalen = 0;
2292f95d4633SHajimu UMEMOTO 	struct ip6_ext *ip6e;
2293f95d4633SHajimu UMEMOTO 	int error = 0;
2294f95d4633SHajimu UMEMOTO 	struct in6_pktinfo null_pktinfo;
2295f95d4633SHajimu UMEMOTO 	int deftclass = 0, on;
2296f95d4633SHajimu UMEMOTO 	int defminmtu = IP6PO_MINMTU_MCASTONLY;
2297f95d4633SHajimu UMEMOTO 	int defpreftemp = IP6PO_TEMPADDR_SYSTEM;
2298f95d4633SHajimu UMEMOTO 
2299f95d4633SHajimu UMEMOTO 	switch (optname) {
2300f95d4633SHajimu UMEMOTO 	case IPV6_PKTINFO:
2301f95d4633SHajimu UMEMOTO 		if (pktopt && pktopt->ip6po_pktinfo)
2302f95d4633SHajimu UMEMOTO 			optdata = (void *)pktopt->ip6po_pktinfo;
2303f95d4633SHajimu UMEMOTO 		else {
2304f95d4633SHajimu UMEMOTO 			/* XXX: we don't have to do this every time... */
2305f95d4633SHajimu UMEMOTO 			bzero(&null_pktinfo, sizeof(null_pktinfo));
2306f95d4633SHajimu UMEMOTO 			optdata = (void *)&null_pktinfo;
2307f95d4633SHajimu UMEMOTO 		}
2308f95d4633SHajimu UMEMOTO 		optdatalen = sizeof(struct in6_pktinfo);
2309f95d4633SHajimu UMEMOTO 		break;
2310f95d4633SHajimu UMEMOTO 	case IPV6_TCLASS:
2311f95d4633SHajimu UMEMOTO 		if (pktopt && pktopt->ip6po_tclass >= 0)
2312f95d4633SHajimu UMEMOTO 			optdata = (void *)&pktopt->ip6po_tclass;
2313f95d4633SHajimu UMEMOTO 		else
2314f95d4633SHajimu UMEMOTO 			optdata = (void *)&deftclass;
2315f95d4633SHajimu UMEMOTO 		optdatalen = sizeof(int);
2316f95d4633SHajimu UMEMOTO 		break;
2317f95d4633SHajimu UMEMOTO 	case IPV6_HOPOPTS:
2318f95d4633SHajimu UMEMOTO 		if (pktopt && pktopt->ip6po_hbh) {
2319f95d4633SHajimu UMEMOTO 			optdata = (void *)pktopt->ip6po_hbh;
2320f95d4633SHajimu UMEMOTO 			ip6e = (struct ip6_ext *)pktopt->ip6po_hbh;
2321f95d4633SHajimu UMEMOTO 			optdatalen = (ip6e->ip6e_len + 1) << 3;
2322f95d4633SHajimu UMEMOTO 		}
2323f95d4633SHajimu UMEMOTO 		break;
2324f95d4633SHajimu UMEMOTO 	case IPV6_RTHDR:
2325f95d4633SHajimu UMEMOTO 		if (pktopt && pktopt->ip6po_rthdr) {
2326f95d4633SHajimu UMEMOTO 			optdata = (void *)pktopt->ip6po_rthdr;
2327f95d4633SHajimu UMEMOTO 			ip6e = (struct ip6_ext *)pktopt->ip6po_rthdr;
2328f95d4633SHajimu UMEMOTO 			optdatalen = (ip6e->ip6e_len + 1) << 3;
2329f95d4633SHajimu UMEMOTO 		}
2330f95d4633SHajimu UMEMOTO 		break;
2331f95d4633SHajimu UMEMOTO 	case IPV6_RTHDRDSTOPTS:
2332f95d4633SHajimu UMEMOTO 		if (pktopt && pktopt->ip6po_dest1) {
2333f95d4633SHajimu UMEMOTO 			optdata = (void *)pktopt->ip6po_dest1;
2334f95d4633SHajimu UMEMOTO 			ip6e = (struct ip6_ext *)pktopt->ip6po_dest1;
2335f95d4633SHajimu UMEMOTO 			optdatalen = (ip6e->ip6e_len + 1) << 3;
2336f95d4633SHajimu UMEMOTO 		}
2337f95d4633SHajimu UMEMOTO 		break;
2338f95d4633SHajimu UMEMOTO 	case IPV6_DSTOPTS:
2339f95d4633SHajimu UMEMOTO 		if (pktopt && pktopt->ip6po_dest2) {
2340f95d4633SHajimu UMEMOTO 			optdata = (void *)pktopt->ip6po_dest2;
2341f95d4633SHajimu UMEMOTO 			ip6e = (struct ip6_ext *)pktopt->ip6po_dest2;
2342f95d4633SHajimu UMEMOTO 			optdatalen = (ip6e->ip6e_len + 1) << 3;
2343f95d4633SHajimu UMEMOTO 		}
2344f95d4633SHajimu UMEMOTO 		break;
2345f95d4633SHajimu UMEMOTO 	case IPV6_NEXTHOP:
2346f95d4633SHajimu UMEMOTO 		if (pktopt && pktopt->ip6po_nexthop) {
2347f95d4633SHajimu UMEMOTO 			optdata = (void *)pktopt->ip6po_nexthop;
2348f95d4633SHajimu UMEMOTO 			optdatalen = pktopt->ip6po_nexthop->sa_len;
2349f95d4633SHajimu UMEMOTO 		}
2350f95d4633SHajimu UMEMOTO 		break;
2351f95d4633SHajimu UMEMOTO 	case IPV6_USE_MIN_MTU:
2352f95d4633SHajimu UMEMOTO 		if (pktopt)
2353f95d4633SHajimu UMEMOTO 			optdata = (void *)&pktopt->ip6po_minmtu;
2354f95d4633SHajimu UMEMOTO 		else
2355f95d4633SHajimu UMEMOTO 			optdata = (void *)&defminmtu;
2356f95d4633SHajimu UMEMOTO 		optdatalen = sizeof(int);
2357f95d4633SHajimu UMEMOTO 		break;
2358f95d4633SHajimu UMEMOTO 	case IPV6_DONTFRAG:
2359f95d4633SHajimu UMEMOTO 		if (pktopt && ((pktopt->ip6po_flags) & IP6PO_DONTFRAG))
2360f95d4633SHajimu UMEMOTO 			on = 1;
2361f95d4633SHajimu UMEMOTO 		else
2362f95d4633SHajimu UMEMOTO 			on = 0;
2363f95d4633SHajimu UMEMOTO 		optdata = (void *)&on;
2364f95d4633SHajimu UMEMOTO 		optdatalen = sizeof(on);
2365f95d4633SHajimu UMEMOTO 		break;
2366f95d4633SHajimu UMEMOTO 	case IPV6_PREFER_TEMPADDR:
2367f95d4633SHajimu UMEMOTO 		if (pktopt)
2368f95d4633SHajimu UMEMOTO 			optdata = (void *)&pktopt->ip6po_prefer_tempaddr;
2369f95d4633SHajimu UMEMOTO 		else
2370f95d4633SHajimu UMEMOTO 			optdata = (void *)&defpreftemp;
2371f95d4633SHajimu UMEMOTO 		optdatalen = sizeof(int);
2372f95d4633SHajimu UMEMOTO 		break;
2373f95d4633SHajimu UMEMOTO 	default:		/* should not happen */
2374f95d4633SHajimu UMEMOTO #ifdef DIAGNOSTIC
2375f95d4633SHajimu UMEMOTO 		panic("ip6_getpcbopt: unexpected option\n");
2376f95d4633SHajimu UMEMOTO #endif
2377f95d4633SHajimu UMEMOTO 		return (ENOPROTOOPT);
2378f95d4633SHajimu UMEMOTO 	}
2379f95d4633SHajimu UMEMOTO 
2380f95d4633SHajimu UMEMOTO 	error = sooptcopyout(sopt, optdata, optdatalen);
2381f95d4633SHajimu UMEMOTO 
2382f95d4633SHajimu UMEMOTO 	return (error);
238333841545SHajimu UMEMOTO }
238433841545SHajimu UMEMOTO 
238533841545SHajimu UMEMOTO void
2386f95d4633SHajimu UMEMOTO ip6_clearpktopts(pktopt, optname)
238733841545SHajimu UMEMOTO 	struct ip6_pktopts *pktopt;
2388f95d4633SHajimu UMEMOTO 	int optname;
238933841545SHajimu UMEMOTO {
2390f95d4633SHajimu UMEMOTO 	int needfree;
239133841545SHajimu UMEMOTO 
2392f95d4633SHajimu UMEMOTO 	needfree = pktopt->needfree;
2393f95d4633SHajimu UMEMOTO 
2394f95d4633SHajimu UMEMOTO 	if (optname == -1 || optname == IPV6_PKTINFO) {
239533841545SHajimu UMEMOTO 		if (needfree && pktopt->ip6po_pktinfo)
239633841545SHajimu UMEMOTO 			free(pktopt->ip6po_pktinfo, M_IP6OPT);
239733841545SHajimu UMEMOTO 		pktopt->ip6po_pktinfo = NULL;
239833841545SHajimu UMEMOTO 	}
2399f95d4633SHajimu UMEMOTO 	if (optname == -1 || optname == IPV6_HOPLIMIT)
240033841545SHajimu UMEMOTO 		pktopt->ip6po_hlim = -1;
2401f95d4633SHajimu UMEMOTO 	if (optname == -1 || optname == IPV6_TCLASS)
2402f95d4633SHajimu UMEMOTO 		pktopt->ip6po_tclass = -1;
2403f95d4633SHajimu UMEMOTO 	if (optname == -1 || optname == IPV6_NEXTHOP) {
2404f95d4633SHajimu UMEMOTO 		if (pktopt->ip6po_nextroute.ro_rt) {
2405f95d4633SHajimu UMEMOTO 			RTFREE(pktopt->ip6po_nextroute.ro_rt);
2406f95d4633SHajimu UMEMOTO 			pktopt->ip6po_nextroute.ro_rt = NULL;
2407f95d4633SHajimu UMEMOTO 		}
240833841545SHajimu UMEMOTO 		if (needfree && pktopt->ip6po_nexthop)
240933841545SHajimu UMEMOTO 			free(pktopt->ip6po_nexthop, M_IP6OPT);
241033841545SHajimu UMEMOTO 		pktopt->ip6po_nexthop = NULL;
241133841545SHajimu UMEMOTO 	}
2412f95d4633SHajimu UMEMOTO 	if (optname == -1 || optname == IPV6_HOPOPTS) {
241333841545SHajimu UMEMOTO 		if (needfree && pktopt->ip6po_hbh)
241433841545SHajimu UMEMOTO 			free(pktopt->ip6po_hbh, M_IP6OPT);
241533841545SHajimu UMEMOTO 		pktopt->ip6po_hbh = NULL;
241633841545SHajimu UMEMOTO 	}
2417f95d4633SHajimu UMEMOTO 	if (optname == -1 || optname == IPV6_RTHDRDSTOPTS) {
241833841545SHajimu UMEMOTO 		if (needfree && pktopt->ip6po_dest1)
241933841545SHajimu UMEMOTO 			free(pktopt->ip6po_dest1, M_IP6OPT);
242033841545SHajimu UMEMOTO 		pktopt->ip6po_dest1 = NULL;
242133841545SHajimu UMEMOTO 	}
2422f95d4633SHajimu UMEMOTO 	if (optname == -1 || optname == IPV6_RTHDR) {
242333841545SHajimu UMEMOTO 		if (needfree && pktopt->ip6po_rhinfo.ip6po_rhi_rthdr)
242433841545SHajimu UMEMOTO 			free(pktopt->ip6po_rhinfo.ip6po_rhi_rthdr, M_IP6OPT);
242533841545SHajimu UMEMOTO 		pktopt->ip6po_rhinfo.ip6po_rhi_rthdr = NULL;
242633841545SHajimu UMEMOTO 		if (pktopt->ip6po_route.ro_rt) {
242733841545SHajimu UMEMOTO 			RTFREE(pktopt->ip6po_route.ro_rt);
242833841545SHajimu UMEMOTO 			pktopt->ip6po_route.ro_rt = NULL;
242933841545SHajimu UMEMOTO 		}
243033841545SHajimu UMEMOTO 	}
2431f95d4633SHajimu UMEMOTO 	if (optname == -1 || optname == IPV6_DSTOPTS) {
243233841545SHajimu UMEMOTO 		if (needfree && pktopt->ip6po_dest2)
243333841545SHajimu UMEMOTO 			free(pktopt->ip6po_dest2, M_IP6OPT);
243433841545SHajimu UMEMOTO 		pktopt->ip6po_dest2 = NULL;
243533841545SHajimu UMEMOTO 	}
243633841545SHajimu UMEMOTO }
243733841545SHajimu UMEMOTO 
243833841545SHajimu UMEMOTO #define PKTOPT_EXTHDRCPY(type) \
243933841545SHajimu UMEMOTO do {\
244033841545SHajimu UMEMOTO 	if (src->type) {\
24417efe5d92SHajimu UMEMOTO 		int hlen = (((struct ip6_ext *)src->type)->ip6e_len + 1) << 3;\
244233841545SHajimu UMEMOTO 		dst->type = malloc(hlen, M_IP6OPT, canwait);\
244333841545SHajimu UMEMOTO 		if (dst->type == NULL && canwait == M_NOWAIT)\
244433841545SHajimu UMEMOTO 			goto bad;\
244533841545SHajimu UMEMOTO 		bcopy(src->type, dst->type, hlen);\
244633841545SHajimu UMEMOTO 	}\
24477efe5d92SHajimu UMEMOTO } while (/*CONSTCOND*/ 0)
244833841545SHajimu UMEMOTO 
244933841545SHajimu UMEMOTO struct ip6_pktopts *
245033841545SHajimu UMEMOTO ip6_copypktopts(src, canwait)
245133841545SHajimu UMEMOTO 	struct ip6_pktopts *src;
245233841545SHajimu UMEMOTO 	int canwait;
245333841545SHajimu UMEMOTO {
245433841545SHajimu UMEMOTO 	struct ip6_pktopts *dst;
245533841545SHajimu UMEMOTO 
245633841545SHajimu UMEMOTO 	if (src == NULL) {
245733841545SHajimu UMEMOTO 		printf("ip6_clearpktopts: invalid argument\n");
245833841545SHajimu UMEMOTO 		return (NULL);
245933841545SHajimu UMEMOTO 	}
246033841545SHajimu UMEMOTO 
246133841545SHajimu UMEMOTO 	dst = malloc(sizeof(*dst), M_IP6OPT, canwait);
246233841545SHajimu UMEMOTO 	if (dst == NULL && canwait == M_NOWAIT)
246335f6695bSHajimu UMEMOTO 		return (NULL);
246433841545SHajimu UMEMOTO 	bzero(dst, sizeof(*dst));
2465f95d4633SHajimu UMEMOTO 	dst->needfree = 1;
246633841545SHajimu UMEMOTO 
246733841545SHajimu UMEMOTO 	dst->ip6po_hlim = src->ip6po_hlim;
2468f95d4633SHajimu UMEMOTO 	dst->ip6po_tclass = src->ip6po_tclass;
2469f95d4633SHajimu UMEMOTO 	dst->ip6po_flags = src->ip6po_flags;
247033841545SHajimu UMEMOTO 	if (src->ip6po_pktinfo) {
247133841545SHajimu UMEMOTO 		dst->ip6po_pktinfo = malloc(sizeof(*dst->ip6po_pktinfo),
247233841545SHajimu UMEMOTO 		    M_IP6OPT, canwait);
247333841545SHajimu UMEMOTO 		if (dst->ip6po_pktinfo == NULL && canwait == M_NOWAIT)
247433841545SHajimu UMEMOTO 			goto bad;
247533841545SHajimu UMEMOTO 		*dst->ip6po_pktinfo = *src->ip6po_pktinfo;
247633841545SHajimu UMEMOTO 	}
247733841545SHajimu UMEMOTO 	if (src->ip6po_nexthop) {
247833841545SHajimu UMEMOTO 		dst->ip6po_nexthop = malloc(src->ip6po_nexthop->sa_len,
247933841545SHajimu UMEMOTO 		    M_IP6OPT, canwait);
248033841545SHajimu UMEMOTO 		if (dst->ip6po_nexthop == NULL && canwait == M_NOWAIT)
248133841545SHajimu UMEMOTO 			goto bad;
248233841545SHajimu UMEMOTO 		bcopy(src->ip6po_nexthop, dst->ip6po_nexthop,
248333841545SHajimu UMEMOTO 		    src->ip6po_nexthop->sa_len);
248433841545SHajimu UMEMOTO 	}
248533841545SHajimu UMEMOTO 	PKTOPT_EXTHDRCPY(ip6po_hbh);
248633841545SHajimu UMEMOTO 	PKTOPT_EXTHDRCPY(ip6po_dest1);
248733841545SHajimu UMEMOTO 	PKTOPT_EXTHDRCPY(ip6po_dest2);
248833841545SHajimu UMEMOTO 	PKTOPT_EXTHDRCPY(ip6po_rthdr); /* not copy the cached route */
248933841545SHajimu UMEMOTO 	return (dst);
249033841545SHajimu UMEMOTO 
249133841545SHajimu UMEMOTO   bad:
249233841545SHajimu UMEMOTO 	if (dst->ip6po_pktinfo) free(dst->ip6po_pktinfo, M_IP6OPT);
249333841545SHajimu UMEMOTO 	if (dst->ip6po_nexthop) free(dst->ip6po_nexthop, M_IP6OPT);
249433841545SHajimu UMEMOTO 	if (dst->ip6po_hbh) free(dst->ip6po_hbh, M_IP6OPT);
249533841545SHajimu UMEMOTO 	if (dst->ip6po_dest1) free(dst->ip6po_dest1, M_IP6OPT);
249633841545SHajimu UMEMOTO 	if (dst->ip6po_dest2) free(dst->ip6po_dest2, M_IP6OPT);
249733841545SHajimu UMEMOTO 	if (dst->ip6po_rthdr) free(dst->ip6po_rthdr, M_IP6OPT);
249835f6695bSHajimu UMEMOTO 	free(dst, M_IP6OPT);
249933841545SHajimu UMEMOTO 	return (NULL);
250033841545SHajimu UMEMOTO }
250133841545SHajimu UMEMOTO #undef PKTOPT_EXTHDRCPY
250233841545SHajimu UMEMOTO 
250333841545SHajimu UMEMOTO void
250433841545SHajimu UMEMOTO ip6_freepcbopts(pktopt)
250533841545SHajimu UMEMOTO 	struct ip6_pktopts *pktopt;
250633841545SHajimu UMEMOTO {
250733841545SHajimu UMEMOTO 	if (pktopt == NULL)
250833841545SHajimu UMEMOTO 		return;
250933841545SHajimu UMEMOTO 
2510f95d4633SHajimu UMEMOTO 	ip6_clearpktopts(pktopt, -1);
251133841545SHajimu UMEMOTO 
251233841545SHajimu UMEMOTO 	free(pktopt, M_IP6OPT);
251333841545SHajimu UMEMOTO }
251433841545SHajimu UMEMOTO 
251533841545SHajimu UMEMOTO /*
251682cd038dSYoshinobu Inoue  * Set the IP6 multicast options in response to user setsockopt().
251782cd038dSYoshinobu Inoue  */
251882cd038dSYoshinobu Inoue static int
251982cd038dSYoshinobu Inoue ip6_setmoptions(optname, im6op, m)
252082cd038dSYoshinobu Inoue 	int optname;
252182cd038dSYoshinobu Inoue 	struct ip6_moptions **im6op;
252282cd038dSYoshinobu Inoue 	struct mbuf *m;
252382cd038dSYoshinobu Inoue {
252482cd038dSYoshinobu Inoue 	int error = 0;
252582cd038dSYoshinobu Inoue 	u_int loop, ifindex;
252682cd038dSYoshinobu Inoue 	struct ipv6_mreq *mreq;
252782cd038dSYoshinobu Inoue 	struct ifnet *ifp;
252882cd038dSYoshinobu Inoue 	struct ip6_moptions *im6o = *im6op;
252982cd038dSYoshinobu Inoue 	struct route_in6 ro;
253082cd038dSYoshinobu Inoue 	struct sockaddr_in6 *dst;
253182cd038dSYoshinobu Inoue 	struct in6_multi_mship *imm;
25327efe5d92SHajimu UMEMOTO 	struct thread *td = curthread;
253382cd038dSYoshinobu Inoue 
253482cd038dSYoshinobu Inoue 	if (im6o == NULL) {
253582cd038dSYoshinobu Inoue 		/*
253682cd038dSYoshinobu Inoue 		 * No multicast option buffer attached to the pcb;
253782cd038dSYoshinobu Inoue 		 * allocate one and initialize to default values.
253882cd038dSYoshinobu Inoue 		 */
253982cd038dSYoshinobu Inoue 		im6o = (struct ip6_moptions *)
2540a163d034SWarner Losh 			malloc(sizeof(*im6o), M_IPMOPTS, M_WAITOK);
254182cd038dSYoshinobu Inoue 
254282cd038dSYoshinobu Inoue 		if (im6o == NULL)
254382cd038dSYoshinobu Inoue 			return (ENOBUFS);
254482cd038dSYoshinobu Inoue 		*im6op = im6o;
254582cd038dSYoshinobu Inoue 		im6o->im6o_multicast_ifp = NULL;
254682cd038dSYoshinobu Inoue 		im6o->im6o_multicast_hlim = ip6_defmcasthlim;
254782cd038dSYoshinobu Inoue 		im6o->im6o_multicast_loop = IPV6_DEFAULT_MULTICAST_LOOP;
254882cd038dSYoshinobu Inoue 		LIST_INIT(&im6o->im6o_memberships);
254982cd038dSYoshinobu Inoue 	}
255082cd038dSYoshinobu Inoue 
255182cd038dSYoshinobu Inoue 	switch (optname) {
255282cd038dSYoshinobu Inoue 
255382cd038dSYoshinobu Inoue 	case IPV6_MULTICAST_IF:
255482cd038dSYoshinobu Inoue 		/*
255582cd038dSYoshinobu Inoue 		 * Select the interface for outgoing multicast packets.
255682cd038dSYoshinobu Inoue 		 */
255782cd038dSYoshinobu Inoue 		if (m == NULL || m->m_len != sizeof(u_int)) {
255882cd038dSYoshinobu Inoue 			error = EINVAL;
255982cd038dSYoshinobu Inoue 			break;
256082cd038dSYoshinobu Inoue 		}
256133841545SHajimu UMEMOTO 		bcopy(mtod(m, u_int *), &ifindex, sizeof(ifindex));
256282cd038dSYoshinobu Inoue 		if (ifindex < 0 || if_index < ifindex) {
256382cd038dSYoshinobu Inoue 			error = ENXIO;	/* XXX EINVAL? */
256482cd038dSYoshinobu Inoue 			break;
256582cd038dSYoshinobu Inoue 		}
2566f9132cebSJonathan Lemon 		ifp = ifnet_byindex(ifindex);
256782cd038dSYoshinobu Inoue 		if (ifp == NULL || (ifp->if_flags & IFF_MULTICAST) == 0) {
256882cd038dSYoshinobu Inoue 			error = EADDRNOTAVAIL;
256982cd038dSYoshinobu Inoue 			break;
257082cd038dSYoshinobu Inoue 		}
257182cd038dSYoshinobu Inoue 		im6o->im6o_multicast_ifp = ifp;
257282cd038dSYoshinobu Inoue 		break;
257382cd038dSYoshinobu Inoue 
257482cd038dSYoshinobu Inoue 	case IPV6_MULTICAST_HOPS:
257582cd038dSYoshinobu Inoue 	    {
257682cd038dSYoshinobu Inoue 		/*
257782cd038dSYoshinobu Inoue 		 * Set the IP6 hoplimit for outgoing multicast packets.
257882cd038dSYoshinobu Inoue 		 */
257982cd038dSYoshinobu Inoue 		int optval;
258082cd038dSYoshinobu Inoue 		if (m == NULL || m->m_len != sizeof(int)) {
258182cd038dSYoshinobu Inoue 			error = EINVAL;
258282cd038dSYoshinobu Inoue 			break;
258382cd038dSYoshinobu Inoue 		}
258433841545SHajimu UMEMOTO 		bcopy(mtod(m, u_int *), &optval, sizeof(optval));
258582cd038dSYoshinobu Inoue 		if (optval < -1 || optval >= 256)
258682cd038dSYoshinobu Inoue 			error = EINVAL;
258782cd038dSYoshinobu Inoue 		else if (optval == -1)
258882cd038dSYoshinobu Inoue 			im6o->im6o_multicast_hlim = ip6_defmcasthlim;
258982cd038dSYoshinobu Inoue 		else
259082cd038dSYoshinobu Inoue 			im6o->im6o_multicast_hlim = optval;
259182cd038dSYoshinobu Inoue 		break;
259282cd038dSYoshinobu Inoue 	    }
259382cd038dSYoshinobu Inoue 
259482cd038dSYoshinobu Inoue 	case IPV6_MULTICAST_LOOP:
259582cd038dSYoshinobu Inoue 		/*
259682cd038dSYoshinobu Inoue 		 * Set the loopback flag for outgoing multicast packets.
259782cd038dSYoshinobu Inoue 		 * Must be zero or one.
259882cd038dSYoshinobu Inoue 		 */
259933841545SHajimu UMEMOTO 		if (m == NULL || m->m_len != sizeof(u_int)) {
260033841545SHajimu UMEMOTO 			error = EINVAL;
260133841545SHajimu UMEMOTO 			break;
260233841545SHajimu UMEMOTO 		}
260333841545SHajimu UMEMOTO 		bcopy(mtod(m, u_int *), &loop, sizeof(loop));
260433841545SHajimu UMEMOTO 		if (loop > 1) {
260582cd038dSYoshinobu Inoue 			error = EINVAL;
260682cd038dSYoshinobu Inoue 			break;
260782cd038dSYoshinobu Inoue 		}
260882cd038dSYoshinobu Inoue 		im6o->im6o_multicast_loop = loop;
260982cd038dSYoshinobu Inoue 		break;
261082cd038dSYoshinobu Inoue 
261182cd038dSYoshinobu Inoue 	case IPV6_JOIN_GROUP:
261282cd038dSYoshinobu Inoue 		/*
261382cd038dSYoshinobu Inoue 		 * Add a multicast group membership.
261482cd038dSYoshinobu Inoue 		 * Group must be a valid IP6 multicast address.
261582cd038dSYoshinobu Inoue 		 */
261682cd038dSYoshinobu Inoue 		if (m == NULL || m->m_len != sizeof(struct ipv6_mreq)) {
261782cd038dSYoshinobu Inoue 			error = EINVAL;
261882cd038dSYoshinobu Inoue 			break;
261982cd038dSYoshinobu Inoue 		}
262082cd038dSYoshinobu Inoue 		mreq = mtod(m, struct ipv6_mreq *);
262182cd038dSYoshinobu Inoue 		if (IN6_IS_ADDR_UNSPECIFIED(&mreq->ipv6mr_multiaddr)) {
262282cd038dSYoshinobu Inoue 			/*
262382cd038dSYoshinobu Inoue 			 * We use the unspecified address to specify to accept
262482cd038dSYoshinobu Inoue 			 * all multicast addresses. Only super user is allowed
262582cd038dSYoshinobu Inoue 			 * to do this.
262682cd038dSYoshinobu Inoue 			 */
26277efe5d92SHajimu UMEMOTO 			if (suser(td)) {
262882cd038dSYoshinobu Inoue 				error = EACCES;
262982cd038dSYoshinobu Inoue 				break;
263082cd038dSYoshinobu Inoue 			}
263182cd038dSYoshinobu Inoue 		} else if (!IN6_IS_ADDR_MULTICAST(&mreq->ipv6mr_multiaddr)) {
263282cd038dSYoshinobu Inoue 			error = EINVAL;
263382cd038dSYoshinobu Inoue 			break;
263482cd038dSYoshinobu Inoue 		}
263582cd038dSYoshinobu Inoue 
263682cd038dSYoshinobu Inoue 		/*
263782cd038dSYoshinobu Inoue 		 * If the interface is specified, validate it.
263882cd038dSYoshinobu Inoue 		 */
263982cd038dSYoshinobu Inoue 		if (mreq->ipv6mr_interface < 0
264082cd038dSYoshinobu Inoue 		 || if_index < mreq->ipv6mr_interface) {
264182cd038dSYoshinobu Inoue 			error = ENXIO;	/* XXX EINVAL? */
264282cd038dSYoshinobu Inoue 			break;
264382cd038dSYoshinobu Inoue 		}
264482cd038dSYoshinobu Inoue 		/*
264582cd038dSYoshinobu Inoue 		 * If no interface was explicitly specified, choose an
264682cd038dSYoshinobu Inoue 		 * appropriate one according to the given multicast address.
264782cd038dSYoshinobu Inoue 		 */
264882cd038dSYoshinobu Inoue 		if (mreq->ipv6mr_interface == 0) {
264982cd038dSYoshinobu Inoue 			/*
265082cd038dSYoshinobu Inoue 			 * If the multicast address is in node-local scope,
265182cd038dSYoshinobu Inoue 			 * the interface should be a loopback interface.
265282cd038dSYoshinobu Inoue 			 * Otherwise, look up the routing table for the
265382cd038dSYoshinobu Inoue 			 * address, and choose the outgoing interface.
265482cd038dSYoshinobu Inoue 			 *   XXX: is it a good approach?
265582cd038dSYoshinobu Inoue 			 */
26569a4f9608SHajimu UMEMOTO 			if (IN6_IS_ADDR_MC_INTFACELOCAL(&mreq->ipv6mr_multiaddr)) {
265782cd038dSYoshinobu Inoue 				ifp = &loif[0];
265882cd038dSYoshinobu Inoue 			} else {
265982cd038dSYoshinobu Inoue 				ro.ro_rt = NULL;
266082cd038dSYoshinobu Inoue 				dst = (struct sockaddr_in6 *)&ro.ro_dst;
266182cd038dSYoshinobu Inoue 				bzero(dst, sizeof(*dst));
266282cd038dSYoshinobu Inoue 				dst->sin6_len = sizeof(struct sockaddr_in6);
266382cd038dSYoshinobu Inoue 				dst->sin6_family = AF_INET6;
266482cd038dSYoshinobu Inoue 				dst->sin6_addr = mreq->ipv6mr_multiaddr;
266582cd038dSYoshinobu Inoue 				rtalloc((struct route *)&ro);
266682cd038dSYoshinobu Inoue 				if (ro.ro_rt == NULL) {
266782cd038dSYoshinobu Inoue 					error = EADDRNOTAVAIL;
266882cd038dSYoshinobu Inoue 					break;
266982cd038dSYoshinobu Inoue 				}
267082cd038dSYoshinobu Inoue 				ifp = ro.ro_rt->rt_ifp;
2671d1dd20beSSam Leffler 				RTFREE(ro.ro_rt);
267282cd038dSYoshinobu Inoue 			}
267382cd038dSYoshinobu Inoue 		} else
2674f9132cebSJonathan Lemon 			ifp = ifnet_byindex(mreq->ipv6mr_interface);
267582cd038dSYoshinobu Inoue 
267682cd038dSYoshinobu Inoue 		/*
267782cd038dSYoshinobu Inoue 		 * See if we found an interface, and confirm that it
267882cd038dSYoshinobu Inoue 		 * supports multicast
267982cd038dSYoshinobu Inoue 		 */
268082cd038dSYoshinobu Inoue 		if (ifp == NULL || (ifp->if_flags & IFF_MULTICAST) == 0) {
268182cd038dSYoshinobu Inoue 			error = EADDRNOTAVAIL;
268282cd038dSYoshinobu Inoue 			break;
268382cd038dSYoshinobu Inoue 		}
268482cd038dSYoshinobu Inoue 		/*
268582cd038dSYoshinobu Inoue 		 * Put interface index into the multicast address,
268682cd038dSYoshinobu Inoue 		 * if the address has link-local scope.
268782cd038dSYoshinobu Inoue 		 */
268882cd038dSYoshinobu Inoue 		if (IN6_IS_ADDR_MC_LINKLOCAL(&mreq->ipv6mr_multiaddr)) {
268982cd038dSYoshinobu Inoue 			mreq->ipv6mr_multiaddr.s6_addr16[1]
269082cd038dSYoshinobu Inoue 				= htons(mreq->ipv6mr_interface);
269182cd038dSYoshinobu Inoue 		}
269282cd038dSYoshinobu Inoue 		/*
269382cd038dSYoshinobu Inoue 		 * See if the membership already exists.
269482cd038dSYoshinobu Inoue 		 */
2695686cdd19SJun-ichiro itojun Hagino 		for (imm = im6o->im6o_memberships.lh_first;
2696686cdd19SJun-ichiro itojun Hagino 		     imm != NULL; imm = imm->i6mm_chain.le_next)
269782cd038dSYoshinobu Inoue 			if (imm->i6mm_maddr->in6m_ifp == ifp &&
269882cd038dSYoshinobu Inoue 			    IN6_ARE_ADDR_EQUAL(&imm->i6mm_maddr->in6m_addr,
269982cd038dSYoshinobu Inoue 					       &mreq->ipv6mr_multiaddr))
270082cd038dSYoshinobu Inoue 				break;
270182cd038dSYoshinobu Inoue 		if (imm != NULL) {
270282cd038dSYoshinobu Inoue 			error = EADDRINUSE;
270382cd038dSYoshinobu Inoue 			break;
270482cd038dSYoshinobu Inoue 		}
270582cd038dSYoshinobu Inoue 		/*
270682cd038dSYoshinobu Inoue 		 * Everything looks good; add a new record to the multicast
270782cd038dSYoshinobu Inoue 		 * address list for the given interface.
270882cd038dSYoshinobu Inoue 		 */
2709a163d034SWarner Losh 		imm = malloc(sizeof(*imm), M_IPMADDR, M_WAITOK);
271082cd038dSYoshinobu Inoue 		if (imm == NULL) {
271182cd038dSYoshinobu Inoue 			error = ENOBUFS;
271282cd038dSYoshinobu Inoue 			break;
271382cd038dSYoshinobu Inoue 		}
271482cd038dSYoshinobu Inoue 		if ((imm->i6mm_maddr =
271582cd038dSYoshinobu Inoue 		     in6_addmulti(&mreq->ipv6mr_multiaddr, ifp, &error)) == NULL) {
271682cd038dSYoshinobu Inoue 			free(imm, M_IPMADDR);
271782cd038dSYoshinobu Inoue 			break;
271882cd038dSYoshinobu Inoue 		}
271982cd038dSYoshinobu Inoue 		LIST_INSERT_HEAD(&im6o->im6o_memberships, imm, i6mm_chain);
272082cd038dSYoshinobu Inoue 		break;
272182cd038dSYoshinobu Inoue 
272282cd038dSYoshinobu Inoue 	case IPV6_LEAVE_GROUP:
272382cd038dSYoshinobu Inoue 		/*
272482cd038dSYoshinobu Inoue 		 * Drop a multicast group membership.
272582cd038dSYoshinobu Inoue 		 * Group must be a valid IP6 multicast address.
272682cd038dSYoshinobu Inoue 		 */
272782cd038dSYoshinobu Inoue 		if (m == NULL || m->m_len != sizeof(struct ipv6_mreq)) {
272882cd038dSYoshinobu Inoue 			error = EINVAL;
272982cd038dSYoshinobu Inoue 			break;
273082cd038dSYoshinobu Inoue 		}
273182cd038dSYoshinobu Inoue 		mreq = mtod(m, struct ipv6_mreq *);
273282cd038dSYoshinobu Inoue 		if (IN6_IS_ADDR_UNSPECIFIED(&mreq->ipv6mr_multiaddr)) {
273344731cabSJohn Baldwin 			if (suser(td)) {
273482cd038dSYoshinobu Inoue 				error = EACCES;
273582cd038dSYoshinobu Inoue 				break;
273682cd038dSYoshinobu Inoue 			}
273782cd038dSYoshinobu Inoue 		} else if (!IN6_IS_ADDR_MULTICAST(&mreq->ipv6mr_multiaddr)) {
273882cd038dSYoshinobu Inoue 			error = EINVAL;
273982cd038dSYoshinobu Inoue 			break;
274082cd038dSYoshinobu Inoue 		}
274182cd038dSYoshinobu Inoue 		/*
274282cd038dSYoshinobu Inoue 		 * If an interface address was specified, get a pointer
274382cd038dSYoshinobu Inoue 		 * to its ifnet structure.
274482cd038dSYoshinobu Inoue 		 */
274582cd038dSYoshinobu Inoue 		if (mreq->ipv6mr_interface < 0
274682cd038dSYoshinobu Inoue 		 || if_index < mreq->ipv6mr_interface) {
274782cd038dSYoshinobu Inoue 			error = ENXIO;	/* XXX EINVAL? */
274882cd038dSYoshinobu Inoue 			break;
274982cd038dSYoshinobu Inoue 		}
2750f9132cebSJonathan Lemon 		ifp = ifnet_byindex(mreq->ipv6mr_interface);
275182cd038dSYoshinobu Inoue 		/*
275282cd038dSYoshinobu Inoue 		 * Put interface index into the multicast address,
275382cd038dSYoshinobu Inoue 		 * if the address has link-local scope.
275482cd038dSYoshinobu Inoue 		 */
275582cd038dSYoshinobu Inoue 		if (IN6_IS_ADDR_MC_LINKLOCAL(&mreq->ipv6mr_multiaddr)) {
275682cd038dSYoshinobu Inoue 			mreq->ipv6mr_multiaddr.s6_addr16[1]
275782cd038dSYoshinobu Inoue 				= htons(mreq->ipv6mr_interface);
275882cd038dSYoshinobu Inoue 		}
27597efe5d92SHajimu UMEMOTO 
276082cd038dSYoshinobu Inoue 		/*
276182cd038dSYoshinobu Inoue 		 * Find the membership in the membership list.
276282cd038dSYoshinobu Inoue 		 */
2763686cdd19SJun-ichiro itojun Hagino 		for (imm = im6o->im6o_memberships.lh_first;
2764686cdd19SJun-ichiro itojun Hagino 		     imm != NULL; imm = imm->i6mm_chain.le_next) {
27657efe5d92SHajimu UMEMOTO 			if ((ifp == NULL || imm->i6mm_maddr->in6m_ifp == ifp) &&
276682cd038dSYoshinobu Inoue 			    IN6_ARE_ADDR_EQUAL(&imm->i6mm_maddr->in6m_addr,
276782cd038dSYoshinobu Inoue 			    &mreq->ipv6mr_multiaddr))
276882cd038dSYoshinobu Inoue 				break;
276982cd038dSYoshinobu Inoue 		}
277082cd038dSYoshinobu Inoue 		if (imm == NULL) {
277182cd038dSYoshinobu Inoue 			/* Unable to resolve interface */
277282cd038dSYoshinobu Inoue 			error = EADDRNOTAVAIL;
277382cd038dSYoshinobu Inoue 			break;
277482cd038dSYoshinobu Inoue 		}
277582cd038dSYoshinobu Inoue 		/*
277682cd038dSYoshinobu Inoue 		 * Give up the multicast address record to which the
277782cd038dSYoshinobu Inoue 		 * membership points.
277882cd038dSYoshinobu Inoue 		 */
277982cd038dSYoshinobu Inoue 		LIST_REMOVE(imm, i6mm_chain);
278082cd038dSYoshinobu Inoue 		in6_delmulti(imm->i6mm_maddr);
278182cd038dSYoshinobu Inoue 		free(imm, M_IPMADDR);
278282cd038dSYoshinobu Inoue 		break;
278382cd038dSYoshinobu Inoue 
278482cd038dSYoshinobu Inoue 	default:
278582cd038dSYoshinobu Inoue 		error = EOPNOTSUPP;
278682cd038dSYoshinobu Inoue 		break;
278782cd038dSYoshinobu Inoue 	}
278882cd038dSYoshinobu Inoue 
278982cd038dSYoshinobu Inoue 	/*
279082cd038dSYoshinobu Inoue 	 * If all options have default values, no need to keep the mbuf.
279182cd038dSYoshinobu Inoue 	 */
279282cd038dSYoshinobu Inoue 	if (im6o->im6o_multicast_ifp == NULL &&
279382cd038dSYoshinobu Inoue 	    im6o->im6o_multicast_hlim == ip6_defmcasthlim &&
279482cd038dSYoshinobu Inoue 	    im6o->im6o_multicast_loop == IPV6_DEFAULT_MULTICAST_LOOP &&
2795686cdd19SJun-ichiro itojun Hagino 	    im6o->im6o_memberships.lh_first == NULL) {
279682cd038dSYoshinobu Inoue 		free(*im6op, M_IPMOPTS);
279782cd038dSYoshinobu Inoue 		*im6op = NULL;
279882cd038dSYoshinobu Inoue 	}
279982cd038dSYoshinobu Inoue 
280082cd038dSYoshinobu Inoue 	return (error);
280182cd038dSYoshinobu Inoue }
280282cd038dSYoshinobu Inoue 
280382cd038dSYoshinobu Inoue /*
280482cd038dSYoshinobu Inoue  * Return the IP6 multicast options in response to user getsockopt().
280582cd038dSYoshinobu Inoue  */
280682cd038dSYoshinobu Inoue static int
280782cd038dSYoshinobu Inoue ip6_getmoptions(optname, im6o, mp)
280882cd038dSYoshinobu Inoue 	int optname;
280933841545SHajimu UMEMOTO 	struct ip6_moptions *im6o;
281033841545SHajimu UMEMOTO 	struct mbuf **mp;
281182cd038dSYoshinobu Inoue {
281282cd038dSYoshinobu Inoue 	u_int *hlim, *loop, *ifindex;
281382cd038dSYoshinobu Inoue 
2814a163d034SWarner Losh 	*mp = m_get(M_TRYWAIT, MT_HEADER);		/* XXX */
281582cd038dSYoshinobu Inoue 
281682cd038dSYoshinobu Inoue 	switch (optname) {
281782cd038dSYoshinobu Inoue 
281882cd038dSYoshinobu Inoue 	case IPV6_MULTICAST_IF:
281982cd038dSYoshinobu Inoue 		ifindex = mtod(*mp, u_int *);
282082cd038dSYoshinobu Inoue 		(*mp)->m_len = sizeof(u_int);
282182cd038dSYoshinobu Inoue 		if (im6o == NULL || im6o->im6o_multicast_ifp == NULL)
282282cd038dSYoshinobu Inoue 			*ifindex = 0;
282382cd038dSYoshinobu Inoue 		else
282482cd038dSYoshinobu Inoue 			*ifindex = im6o->im6o_multicast_ifp->if_index;
282582cd038dSYoshinobu Inoue 		return (0);
282682cd038dSYoshinobu Inoue 
282782cd038dSYoshinobu Inoue 	case IPV6_MULTICAST_HOPS:
282882cd038dSYoshinobu Inoue 		hlim = mtod(*mp, u_int *);
282982cd038dSYoshinobu Inoue 		(*mp)->m_len = sizeof(u_int);
283082cd038dSYoshinobu Inoue 		if (im6o == NULL)
283182cd038dSYoshinobu Inoue 			*hlim = ip6_defmcasthlim;
283282cd038dSYoshinobu Inoue 		else
283382cd038dSYoshinobu Inoue 			*hlim = im6o->im6o_multicast_hlim;
283482cd038dSYoshinobu Inoue 		return (0);
283582cd038dSYoshinobu Inoue 
283682cd038dSYoshinobu Inoue 	case IPV6_MULTICAST_LOOP:
283782cd038dSYoshinobu Inoue 		loop = mtod(*mp, u_int *);
283882cd038dSYoshinobu Inoue 		(*mp)->m_len = sizeof(u_int);
283982cd038dSYoshinobu Inoue 		if (im6o == NULL)
284082cd038dSYoshinobu Inoue 			*loop = ip6_defmcasthlim;
284182cd038dSYoshinobu Inoue 		else
284282cd038dSYoshinobu Inoue 			*loop = im6o->im6o_multicast_loop;
284382cd038dSYoshinobu Inoue 		return (0);
284482cd038dSYoshinobu Inoue 
284582cd038dSYoshinobu Inoue 	default:
284682cd038dSYoshinobu Inoue 		return (EOPNOTSUPP);
284782cd038dSYoshinobu Inoue 	}
284882cd038dSYoshinobu Inoue }
284982cd038dSYoshinobu Inoue 
285082cd038dSYoshinobu Inoue /*
285182cd038dSYoshinobu Inoue  * Discard the IP6 multicast options.
285282cd038dSYoshinobu Inoue  */
285382cd038dSYoshinobu Inoue void
285482cd038dSYoshinobu Inoue ip6_freemoptions(im6o)
285533841545SHajimu UMEMOTO 	struct ip6_moptions *im6o;
285682cd038dSYoshinobu Inoue {
285782cd038dSYoshinobu Inoue 	struct in6_multi_mship *imm;
285882cd038dSYoshinobu Inoue 
285982cd038dSYoshinobu Inoue 	if (im6o == NULL)
286082cd038dSYoshinobu Inoue 		return;
286182cd038dSYoshinobu Inoue 
2862686cdd19SJun-ichiro itojun Hagino 	while ((imm = im6o->im6o_memberships.lh_first) != NULL) {
286382cd038dSYoshinobu Inoue 		LIST_REMOVE(imm, i6mm_chain);
286482cd038dSYoshinobu Inoue 		if (imm->i6mm_maddr)
286582cd038dSYoshinobu Inoue 			in6_delmulti(imm->i6mm_maddr);
286682cd038dSYoshinobu Inoue 		free(imm, M_IPMADDR);
286782cd038dSYoshinobu Inoue 	}
286882cd038dSYoshinobu Inoue 	free(im6o, M_IPMOPTS);
286982cd038dSYoshinobu Inoue }
287082cd038dSYoshinobu Inoue 
287182cd038dSYoshinobu Inoue /*
287282cd038dSYoshinobu Inoue  * Set IPv6 outgoing packet options based on advanced API.
287382cd038dSYoshinobu Inoue  */
287482cd038dSYoshinobu Inoue int
2875f95d4633SHajimu UMEMOTO ip6_setpktoptions(control, opt, stickyopt, priv, needcopy, uproto)
287682cd038dSYoshinobu Inoue 	struct mbuf *control;
2877f95d4633SHajimu UMEMOTO 	struct ip6_pktopts *opt, *stickyopt;
2878f95d4633SHajimu UMEMOTO 	int priv, needcopy, uproto;
287982cd038dSYoshinobu Inoue {
288033841545SHajimu UMEMOTO 	struct cmsghdr *cm = 0;
288182cd038dSYoshinobu Inoue 
288282cd038dSYoshinobu Inoue 	if (control == 0 || opt == 0)
288382cd038dSYoshinobu Inoue 		return (EINVAL);
288482cd038dSYoshinobu Inoue 
2885f95d4633SHajimu UMEMOTO 	if (stickyopt) {
2886f95d4633SHajimu UMEMOTO 		/*
2887f95d4633SHajimu UMEMOTO 		 * If stickyopt is provided, make a local copy of the options
2888f95d4633SHajimu UMEMOTO 		 * for this particular packet, then override them by ancillary
2889f95d4633SHajimu UMEMOTO 		 * objects.
2890f95d4633SHajimu UMEMOTO 		 * XXX: need to gain a reference for the cached route of the
2891f95d4633SHajimu UMEMOTO 		 * next hop in case of the overriding.
2892f95d4633SHajimu UMEMOTO 		 */
2893f95d4633SHajimu UMEMOTO 		*opt = *stickyopt;
2894f95d4633SHajimu UMEMOTO 		if (opt->ip6po_nextroute.ro_rt) {
2895f95d4633SHajimu UMEMOTO 			RT_LOCK(opt->ip6po_nextroute.ro_rt);
2896f95d4633SHajimu UMEMOTO 			opt->ip6po_nextroute.ro_rt->rt_refcnt++;
2897f95d4633SHajimu UMEMOTO 			RT_UNLOCK(opt->ip6po_nextroute.ro_rt);
2898f95d4633SHajimu UMEMOTO 		}
2899f95d4633SHajimu UMEMOTO 	} else
290033841545SHajimu UMEMOTO 		init_ip6pktopts(opt);
2901f95d4633SHajimu UMEMOTO 	opt->needfree = needcopy;
290282cd038dSYoshinobu Inoue 
290382cd038dSYoshinobu Inoue 	/*
290482cd038dSYoshinobu Inoue 	 * XXX: Currently, we assume all the optional information is stored
290582cd038dSYoshinobu Inoue 	 * in a single mbuf.
290682cd038dSYoshinobu Inoue 	 */
290782cd038dSYoshinobu Inoue 	if (control->m_next)
290882cd038dSYoshinobu Inoue 		return (EINVAL);
290982cd038dSYoshinobu Inoue 
291033841545SHajimu UMEMOTO 	for (; control->m_len; control->m_data += CMSG_ALIGN(cm->cmsg_len),
291133841545SHajimu UMEMOTO 	    control->m_len -= CMSG_ALIGN(cm->cmsg_len)) {
2912f95d4633SHajimu UMEMOTO 		int error;
2913f95d4633SHajimu UMEMOTO 
2914f95d4633SHajimu UMEMOTO 		if (control->m_len < CMSG_LEN(0))
2915f95d4633SHajimu UMEMOTO 			return (EINVAL);
2916f95d4633SHajimu UMEMOTO 
291782cd038dSYoshinobu Inoue 		cm = mtod(control, struct cmsghdr *);
291882cd038dSYoshinobu Inoue 		if (cm->cmsg_len == 0 || cm->cmsg_len > control->m_len)
291982cd038dSYoshinobu Inoue 			return (EINVAL);
292082cd038dSYoshinobu Inoue 		if (cm->cmsg_level != IPPROTO_IPV6)
292182cd038dSYoshinobu Inoue 			continue;
292282cd038dSYoshinobu Inoue 
2923f95d4633SHajimu UMEMOTO 		error = ip6_setpktoption(cm->cmsg_type, CMSG_DATA(cm),
2924f95d4633SHajimu UMEMOTO 		    cm->cmsg_len - CMSG_LEN(0), opt, priv, needcopy, 1, uproto);
2925f95d4633SHajimu UMEMOTO 		if (error)
2926f95d4633SHajimu UMEMOTO 			return (error);
2927f95d4633SHajimu UMEMOTO 	}
292882cd038dSYoshinobu Inoue 
2929f95d4633SHajimu UMEMOTO 	return (0);
2930f95d4633SHajimu UMEMOTO }
2931f95d4633SHajimu UMEMOTO 
2932f95d4633SHajimu UMEMOTO /*
2933f95d4633SHajimu UMEMOTO  * Set a particular packet option, as a sticky option or an ancillary data
2934f95d4633SHajimu UMEMOTO  * item.  "len" can be 0 only when it's a sticky option.
2935f95d4633SHajimu UMEMOTO  * We have 4 cases of combination of "sticky" and "cmsg":
2936f95d4633SHajimu UMEMOTO  * "sticky=0, cmsg=0": impossible
2937f95d4633SHajimu UMEMOTO  * "sticky=0, cmsg=1": RFC2292 or rfc2292bis ancillary data
2938f95d4633SHajimu UMEMOTO  * "sticky=1, cmsg=0": rfc2292bis socket option
2939f95d4633SHajimu UMEMOTO  * "sticky=1, cmsg=1": RFC2292 socket option
2940f95d4633SHajimu UMEMOTO  */
2941f95d4633SHajimu UMEMOTO static int
2942f95d4633SHajimu UMEMOTO ip6_setpktoption(optname, buf, len, opt, priv, sticky, cmsg, uproto)
2943f95d4633SHajimu UMEMOTO 	int optname, len, priv, sticky, cmsg, uproto;
2944f95d4633SHajimu UMEMOTO 	u_char *buf;
2945f95d4633SHajimu UMEMOTO 	struct ip6_pktopts *opt;
2946f95d4633SHajimu UMEMOTO {
2947f95d4633SHajimu UMEMOTO 	int minmtupolicy, preftemp;
2948f95d4633SHajimu UMEMOTO 
2949f95d4633SHajimu UMEMOTO 	if (!sticky && !cmsg) {
2950f95d4633SHajimu UMEMOTO #ifdef DIAGNOSTIC
2951f95d4633SHajimu UMEMOTO 		printf("ip6_setpktoption: impossible case\n");
2952f95d4633SHajimu UMEMOTO #endif
2953f95d4633SHajimu UMEMOTO 		return (EINVAL);
2954f95d4633SHajimu UMEMOTO 	}
2955f95d4633SHajimu UMEMOTO 
2956f95d4633SHajimu UMEMOTO 	/*
2957f95d4633SHajimu UMEMOTO 	 * IPV6_2292xxx is for backward compatibility to RFC2292, and should
2958f95d4633SHajimu UMEMOTO 	 * not be specified in the context of rfc2292bis.  Conversely,
2959f95d4633SHajimu UMEMOTO 	 * rfc2292bis types should not be specified in the context of RFC2292.
2960f95d4633SHajimu UMEMOTO 	 */
2961f95d4633SHajimu UMEMOTO 	if (!cmsg) {
2962f95d4633SHajimu UMEMOTO 		switch (optname) {
2963f95d4633SHajimu UMEMOTO 		case IPV6_2292PKTINFO:
2964f95d4633SHajimu UMEMOTO 		case IPV6_2292HOPLIMIT:
2965f95d4633SHajimu UMEMOTO 		case IPV6_2292NEXTHOP:
2966f95d4633SHajimu UMEMOTO 		case IPV6_2292HOPOPTS:
2967f95d4633SHajimu UMEMOTO 		case IPV6_2292DSTOPTS:
2968f95d4633SHajimu UMEMOTO 		case IPV6_2292RTHDR:
2969f95d4633SHajimu UMEMOTO 		case IPV6_2292PKTOPTIONS:
2970f95d4633SHajimu UMEMOTO 			return (ENOPROTOOPT);
2971f95d4633SHajimu UMEMOTO 		}
2972f95d4633SHajimu UMEMOTO 	}
2973f95d4633SHajimu UMEMOTO 	if (sticky && cmsg) {
2974f95d4633SHajimu UMEMOTO 		switch (optname) {
2975f95d4633SHajimu UMEMOTO 		case IPV6_PKTINFO:
2976f95d4633SHajimu UMEMOTO 		case IPV6_HOPLIMIT:
2977f95d4633SHajimu UMEMOTO 		case IPV6_NEXTHOP:
2978f95d4633SHajimu UMEMOTO 		case IPV6_HOPOPTS:
2979f95d4633SHajimu UMEMOTO 		case IPV6_DSTOPTS:
2980f95d4633SHajimu UMEMOTO 		case IPV6_RTHDRDSTOPTS:
2981f95d4633SHajimu UMEMOTO 		case IPV6_RTHDR:
2982f95d4633SHajimu UMEMOTO 		case IPV6_USE_MIN_MTU:
2983f95d4633SHajimu UMEMOTO 		case IPV6_DONTFRAG:
2984f95d4633SHajimu UMEMOTO 		case IPV6_TCLASS:
2985f95d4633SHajimu UMEMOTO 		case IPV6_PREFER_TEMPADDR: /* XXX: not an rfc2292bis option */
2986f95d4633SHajimu UMEMOTO 			return (ENOPROTOOPT);
2987f95d4633SHajimu UMEMOTO 		}
2988f95d4633SHajimu UMEMOTO 	}
2989f95d4633SHajimu UMEMOTO 
2990f95d4633SHajimu UMEMOTO 	switch (optname) {
2991f95d4633SHajimu UMEMOTO 	case IPV6_2292PKTINFO:
2992f95d4633SHajimu UMEMOTO 	case IPV6_PKTINFO:
2993f95d4633SHajimu UMEMOTO 	{
2994f95d4633SHajimu UMEMOTO 		struct ifnet *ifp = NULL;
2995f95d4633SHajimu UMEMOTO 		struct in6_pktinfo *pktinfo;
2996f95d4633SHajimu UMEMOTO 
2997f95d4633SHajimu UMEMOTO 		if (len != sizeof(struct in6_pktinfo))
2998f95d4633SHajimu UMEMOTO 			return (EINVAL);
2999f95d4633SHajimu UMEMOTO 
3000f95d4633SHajimu UMEMOTO 		pktinfo = (struct in6_pktinfo *)buf;
3001f95d4633SHajimu UMEMOTO 
3002f95d4633SHajimu UMEMOTO 		/*
3003f95d4633SHajimu UMEMOTO 		 * An application can clear any sticky IPV6_PKTINFO option by
3004f95d4633SHajimu UMEMOTO 		 * doing a "regular" setsockopt with ipi6_addr being
3005f95d4633SHajimu UMEMOTO 		 * in6addr_any and ipi6_ifindex being zero.
3006f95d4633SHajimu UMEMOTO 		 * [RFC 3542, Section 6]
3007f95d4633SHajimu UMEMOTO 		 */
3008f95d4633SHajimu UMEMOTO 		if (optname == IPV6_PKTINFO && opt->ip6po_pktinfo &&
3009f95d4633SHajimu UMEMOTO 		    pktinfo->ipi6_ifindex == 0 &&
3010f95d4633SHajimu UMEMOTO 		    IN6_IS_ADDR_UNSPECIFIED(&pktinfo->ipi6_addr)) {
3011f95d4633SHajimu UMEMOTO 			ip6_clearpktopts(opt, optname);
3012f95d4633SHajimu UMEMOTO 			break;
3013f95d4633SHajimu UMEMOTO 		}
3014f95d4633SHajimu UMEMOTO 
3015f95d4633SHajimu UMEMOTO 		if (uproto == IPPROTO_TCP && optname == IPV6_PKTINFO &&
3016f95d4633SHajimu UMEMOTO 		    sticky && !IN6_IS_ADDR_UNSPECIFIED(&pktinfo->ipi6_addr)) {
3017f95d4633SHajimu UMEMOTO 			return (EINVAL);
3018f95d4633SHajimu UMEMOTO 		}
3019f95d4633SHajimu UMEMOTO 
3020f95d4633SHajimu UMEMOTO 		/* validate the interface index if specified. */
3021f95d4633SHajimu UMEMOTO 		if (pktinfo->ipi6_ifindex > if_index ||
3022f95d4633SHajimu UMEMOTO 		    pktinfo->ipi6_ifindex < 0) {
3023f95d4633SHajimu UMEMOTO 			 return (ENXIO);
3024f95d4633SHajimu UMEMOTO 		}
3025f95d4633SHajimu UMEMOTO 		if (pktinfo->ipi6_ifindex) {
3026f95d4633SHajimu UMEMOTO 			ifp = ifnet_byindex(pktinfo->ipi6_ifindex);
3027f95d4633SHajimu UMEMOTO 			if (ifp == NULL)
302882cd038dSYoshinobu Inoue 				return (ENXIO);
302982cd038dSYoshinobu Inoue 		}
303082cd038dSYoshinobu Inoue 
303133841545SHajimu UMEMOTO 		/*
3032f95d4633SHajimu UMEMOTO 		 * We store the address anyway, and let in6_selectsrc()
3033f95d4633SHajimu UMEMOTO 		 * validate the specified address.  This is because ipi6_addr
3034f95d4633SHajimu UMEMOTO 		 * may not have enough information about its scope zone, and
3035f95d4633SHajimu UMEMOTO 		 * we may need additional information (such as outgoing
3036f95d4633SHajimu UMEMOTO 		 * interface or the scope zone of a destination address) to
3037f95d4633SHajimu UMEMOTO 		 * disambiguate the scope.
3038f95d4633SHajimu UMEMOTO 		 * XXX: the delay of the validation may confuse the
3039f95d4633SHajimu UMEMOTO 		 * application when it is used as a sticky option.
304033841545SHajimu UMEMOTO 		 */
3041f95d4633SHajimu UMEMOTO 		if (sticky) {
3042f95d4633SHajimu UMEMOTO 			if (opt->ip6po_pktinfo == NULL) {
3043f95d4633SHajimu UMEMOTO 				opt->ip6po_pktinfo = malloc(sizeof(*pktinfo),
3044f95d4633SHajimu UMEMOTO 				    M_IP6OPT, M_WAITOK);
304582cd038dSYoshinobu Inoue 			}
3046f95d4633SHajimu UMEMOTO 			bcopy(pktinfo, opt->ip6po_pktinfo, sizeof(*pktinfo));
3047f95d4633SHajimu UMEMOTO 		} else
3048f95d4633SHajimu UMEMOTO 			opt->ip6po_pktinfo = pktinfo;
304982cd038dSYoshinobu Inoue 		break;
3050f95d4633SHajimu UMEMOTO 	}
305182cd038dSYoshinobu Inoue 
3052f95d4633SHajimu UMEMOTO 	case IPV6_2292HOPLIMIT:
305382cd038dSYoshinobu Inoue 	case IPV6_HOPLIMIT:
3054f95d4633SHajimu UMEMOTO 	{
3055f95d4633SHajimu UMEMOTO 		int *hlimp;
3056f95d4633SHajimu UMEMOTO 
3057f95d4633SHajimu UMEMOTO 		/*
3058f95d4633SHajimu UMEMOTO 		 * RFC 3542 deprecated the usage of sticky IPV6_HOPLIMIT
3059f95d4633SHajimu UMEMOTO 		 * to simplify the ordering among hoplimit options.
3060f95d4633SHajimu UMEMOTO 		 */
3061f95d4633SHajimu UMEMOTO 		if (optname == IPV6_HOPLIMIT && sticky)
3062f95d4633SHajimu UMEMOTO 			return (ENOPROTOOPT);
3063f95d4633SHajimu UMEMOTO 
3064f95d4633SHajimu UMEMOTO 		if (len != sizeof(int))
3065f95d4633SHajimu UMEMOTO 			return (EINVAL);
3066f95d4633SHajimu UMEMOTO 		hlimp = (int *)buf;
3067f95d4633SHajimu UMEMOTO 		if (*hlimp < -1 || *hlimp > 255)
306882cd038dSYoshinobu Inoue 			return (EINVAL);
306982cd038dSYoshinobu Inoue 
3070f95d4633SHajimu UMEMOTO 		opt->ip6po_hlim = *hlimp;
307182cd038dSYoshinobu Inoue 		break;
3072f95d4633SHajimu UMEMOTO 	}
307382cd038dSYoshinobu Inoue 
3074f95d4633SHajimu UMEMOTO 	case IPV6_TCLASS:
3075f95d4633SHajimu UMEMOTO 	{
3076f95d4633SHajimu UMEMOTO 		int tclass;
3077f95d4633SHajimu UMEMOTO 
3078f95d4633SHajimu UMEMOTO 		if (len != sizeof(int))
3079f95d4633SHajimu UMEMOTO 			return (EINVAL);
3080f95d4633SHajimu UMEMOTO 		tclass = *(int *)buf;
3081f95d4633SHajimu UMEMOTO 		if (tclass < -1 || tclass > 255)
3082f95d4633SHajimu UMEMOTO 			return (EINVAL);
3083f95d4633SHajimu UMEMOTO 
3084f95d4633SHajimu UMEMOTO 		opt->ip6po_tclass = tclass;
3085f95d4633SHajimu UMEMOTO 		break;
3086f95d4633SHajimu UMEMOTO 	}
3087f95d4633SHajimu UMEMOTO 
3088f95d4633SHajimu UMEMOTO 	case IPV6_2292NEXTHOP:
308982cd038dSYoshinobu Inoue 	case IPV6_NEXTHOP:
309082cd038dSYoshinobu Inoue 		if (!priv)
309182cd038dSYoshinobu Inoue 			return (EPERM);
309233841545SHajimu UMEMOTO 
3093f95d4633SHajimu UMEMOTO 		if (len == 0) {	/* just remove the option */
3094f95d4633SHajimu UMEMOTO 			ip6_clearpktopts(opt, IPV6_NEXTHOP);
3095f95d4633SHajimu UMEMOTO 			break;
3096f95d4633SHajimu UMEMOTO 		}
3097f95d4633SHajimu UMEMOTO 
309833841545SHajimu UMEMOTO 		/* check if cmsg_len is large enough for sa_len */
3099f95d4633SHajimu UMEMOTO 		if (len < sizeof(struct sockaddr) || len < *buf)
310082cd038dSYoshinobu Inoue 			return (EINVAL);
310182cd038dSYoshinobu Inoue 
3102f95d4633SHajimu UMEMOTO 		switch (((struct sockaddr *)buf)->sa_family) {
3103f95d4633SHajimu UMEMOTO 		case AF_INET6:
3104f95d4633SHajimu UMEMOTO 		{
3105f95d4633SHajimu UMEMOTO 			struct sockaddr_in6 *sa6 = (struct sockaddr_in6 *)buf;
3106f95d4633SHajimu UMEMOTO #if 0
3107f95d4633SHajimu UMEMOTO 			int error;
3108f95d4633SHajimu UMEMOTO #endif
3109f95d4633SHajimu UMEMOTO 
3110f95d4633SHajimu UMEMOTO 			if (sa6->sin6_len != sizeof(struct sockaddr_in6))
3111f95d4633SHajimu UMEMOTO 				return (EINVAL);
3112f95d4633SHajimu UMEMOTO 
3113f95d4633SHajimu UMEMOTO 			if (IN6_IS_ADDR_UNSPECIFIED(&sa6->sin6_addr) ||
3114f95d4633SHajimu UMEMOTO 			    IN6_IS_ADDR_MULTICAST(&sa6->sin6_addr)) {
3115f95d4633SHajimu UMEMOTO 				return (EINVAL);
3116f95d4633SHajimu UMEMOTO 			}
3117f95d4633SHajimu UMEMOTO #if 0
3118f95d4633SHajimu UMEMOTO 			if ((error = scope6_check_id(sa6, ip6_use_defzone))
3119f95d4633SHajimu UMEMOTO 			    != 0) {
3120f95d4633SHajimu UMEMOTO 				return (error);
3121f95d4633SHajimu UMEMOTO 			}
3122f95d4633SHajimu UMEMOTO #endif
3123f95d4633SHajimu UMEMOTO 			sa6->sin6_scope_id = 0; /* XXX */
3124f95d4633SHajimu UMEMOTO 			break;
3125f95d4633SHajimu UMEMOTO 		}
3126f95d4633SHajimu UMEMOTO 		case AF_LINK:	/* should eventually be supported */
3127f95d4633SHajimu UMEMOTO 		default:
3128f95d4633SHajimu UMEMOTO 			return (EAFNOSUPPORT);
3129f95d4633SHajimu UMEMOTO 		}
3130f95d4633SHajimu UMEMOTO 
3131f95d4633SHajimu UMEMOTO 		/* turn off the previous option, then set the new option. */
3132f95d4633SHajimu UMEMOTO 		ip6_clearpktopts(opt, IPV6_NEXTHOP);
3133f95d4633SHajimu UMEMOTO 		if (sticky) {
3134f95d4633SHajimu UMEMOTO 			opt->ip6po_nexthop = malloc(*buf, M_IP6OPT, M_WAITOK);
3135f95d4633SHajimu UMEMOTO 			bcopy(buf, opt->ip6po_nexthop, *buf);
313633841545SHajimu UMEMOTO 		} else
3137f95d4633SHajimu UMEMOTO 			opt->ip6po_nexthop = (struct sockaddr *)buf;
313882cd038dSYoshinobu Inoue 		break;
313982cd038dSYoshinobu Inoue 
3140f95d4633SHajimu UMEMOTO 	case IPV6_2292HOPOPTS:
314182cd038dSYoshinobu Inoue 	case IPV6_HOPOPTS:
314233841545SHajimu UMEMOTO 	{
314333841545SHajimu UMEMOTO 		struct ip6_hbh *hbh;
314433841545SHajimu UMEMOTO 		int hbhlen;
314533841545SHajimu UMEMOTO 
3146f95d4633SHajimu UMEMOTO 		/*
3147f95d4633SHajimu UMEMOTO 		 * XXX: We don't allow a non-privileged user to set ANY HbH
3148f95d4633SHajimu UMEMOTO 		 * options, since per-option restriction has too much
3149f95d4633SHajimu UMEMOTO 		 * overhead.
3150f95d4633SHajimu UMEMOTO 		 */
3151f95d4633SHajimu UMEMOTO 		if (!priv)
3152f95d4633SHajimu UMEMOTO 			return (EPERM);
3153f95d4633SHajimu UMEMOTO 
3154f95d4633SHajimu UMEMOTO 		if (len == 0) {
3155f95d4633SHajimu UMEMOTO 			ip6_clearpktopts(opt, IPV6_HOPOPTS);
3156f95d4633SHajimu UMEMOTO 			break;	/* just remove the option */
3157f95d4633SHajimu UMEMOTO 		}
3158f95d4633SHajimu UMEMOTO 
3159f95d4633SHajimu UMEMOTO 		/* message length validation */
3160f95d4633SHajimu UMEMOTO 		if (len < sizeof(struct ip6_hbh))
316182cd038dSYoshinobu Inoue 			return (EINVAL);
3162f95d4633SHajimu UMEMOTO 		hbh = (struct ip6_hbh *)buf;
316333841545SHajimu UMEMOTO 		hbhlen = (hbh->ip6h_len + 1) << 3;
3164f95d4633SHajimu UMEMOTO 		if (len != hbhlen)
316582cd038dSYoshinobu Inoue 			return (EINVAL);
316633841545SHajimu UMEMOTO 
3167f95d4633SHajimu UMEMOTO 		/* turn off the previous option, then set the new option. */
3168f95d4633SHajimu UMEMOTO 		ip6_clearpktopts(opt, IPV6_HOPOPTS);
3169f95d4633SHajimu UMEMOTO 		if (sticky) {
3170f95d4633SHajimu UMEMOTO 			opt->ip6po_hbh = malloc(hbhlen, M_IP6OPT, M_WAITOK);
317133841545SHajimu UMEMOTO 			bcopy(hbh, opt->ip6po_hbh, hbhlen);
317233841545SHajimu UMEMOTO 		} else
317333841545SHajimu UMEMOTO 			opt->ip6po_hbh = hbh;
3174f95d4633SHajimu UMEMOTO 
317582cd038dSYoshinobu Inoue 		break;
317633841545SHajimu UMEMOTO 	}
317782cd038dSYoshinobu Inoue 
3178f95d4633SHajimu UMEMOTO 	case IPV6_2292DSTOPTS:
317982cd038dSYoshinobu Inoue 	case IPV6_DSTOPTS:
3180f95d4633SHajimu UMEMOTO 	case IPV6_RTHDRDSTOPTS:
318133841545SHajimu UMEMOTO 	{
3182f95d4633SHajimu UMEMOTO 		struct ip6_dest *dest, **newdest = NULL;
318333841545SHajimu UMEMOTO 		int destlen;
318433841545SHajimu UMEMOTO 
3185f95d4633SHajimu UMEMOTO 		if (!priv)	/* XXX: see the comment for IPV6_HOPOPTS */
3186f95d4633SHajimu UMEMOTO 			return (EPERM);
3187f95d4633SHajimu UMEMOTO 
3188f95d4633SHajimu UMEMOTO 		if (len == 0) {
3189f95d4633SHajimu UMEMOTO 			ip6_clearpktopts(opt, optname);
3190f95d4633SHajimu UMEMOTO 			break;	/* just remove the option */
3191f95d4633SHajimu UMEMOTO 		}
3192f95d4633SHajimu UMEMOTO 
3193f95d4633SHajimu UMEMOTO 		/* message length validation */
3194f95d4633SHajimu UMEMOTO 		if (len < sizeof(struct ip6_dest))
319582cd038dSYoshinobu Inoue 			return (EINVAL);
3196f95d4633SHajimu UMEMOTO 		dest = (struct ip6_dest *)buf;
319733841545SHajimu UMEMOTO 		destlen = (dest->ip6d_len + 1) << 3;
3198f95d4633SHajimu UMEMOTO 		if (len != destlen)
319933841545SHajimu UMEMOTO 			return (EINVAL);
320082cd038dSYoshinobu Inoue 
320182cd038dSYoshinobu Inoue 		/*
3202f95d4633SHajimu UMEMOTO 		 * Determine the position that the destination options header
3203f95d4633SHajimu UMEMOTO 		 * should be inserted; before or after the routing header.
3204f95d4633SHajimu UMEMOTO 		 */
3205f95d4633SHajimu UMEMOTO 		switch (optname) {
3206f95d4633SHajimu UMEMOTO 		case IPV6_2292DSTOPTS:
3207f95d4633SHajimu UMEMOTO 			/*
3208f95d4633SHajimu UMEMOTO 			 * The old advacned API is ambiguous on this point.
3209f95d4633SHajimu UMEMOTO 			 * Our approach is to determine the position based
3210f95d4633SHajimu UMEMOTO 			 * according to the existence of a routing header.
3211f95d4633SHajimu UMEMOTO 			 * Note, however, that this depends on the order of the
3212f95d4633SHajimu UMEMOTO 			 * extension headers in the ancillary data; the 1st
3213f95d4633SHajimu UMEMOTO 			 * part of the destination options header must appear
3214f95d4633SHajimu UMEMOTO 			 * before the routing header in the ancillary data,
3215f95d4633SHajimu UMEMOTO 			 * too.
3216f95d4633SHajimu UMEMOTO 			 * RFC2292bis solved the ambiguity by introducing
3217f95d4633SHajimu UMEMOTO 			 * separate ancillary data or option types.
321882cd038dSYoshinobu Inoue 			 */
321933841545SHajimu UMEMOTO 			if (opt->ip6po_rthdr == NULL)
322033841545SHajimu UMEMOTO 				newdest = &opt->ip6po_dest1;
322133841545SHajimu UMEMOTO 			else
322233841545SHajimu UMEMOTO 				newdest = &opt->ip6po_dest2;
3223f95d4633SHajimu UMEMOTO 			break;
3224f95d4633SHajimu UMEMOTO 		case IPV6_RTHDRDSTOPTS:
3225f95d4633SHajimu UMEMOTO 			newdest = &opt->ip6po_dest1;
3226f95d4633SHajimu UMEMOTO 			break;
3227f95d4633SHajimu UMEMOTO 		case IPV6_DSTOPTS:
3228f95d4633SHajimu UMEMOTO 			newdest = &opt->ip6po_dest2;
3229f95d4633SHajimu UMEMOTO 			break;
3230f95d4633SHajimu UMEMOTO 		}
323133841545SHajimu UMEMOTO 
3232f95d4633SHajimu UMEMOTO 		/* turn off the previous option, then set the new option. */
3233f95d4633SHajimu UMEMOTO 		ip6_clearpktopts(opt, optname);
3234f95d4633SHajimu UMEMOTO 		if (sticky) {
3235a163d034SWarner Losh 			*newdest = malloc(destlen, M_IP6OPT, M_WAITOK);
323633841545SHajimu UMEMOTO 			bcopy(dest, *newdest, destlen);
323733841545SHajimu UMEMOTO 		} else
323833841545SHajimu UMEMOTO 			*newdest = dest;
323933841545SHajimu UMEMOTO 
324082cd038dSYoshinobu Inoue 		break;
324133841545SHajimu UMEMOTO 	}
324282cd038dSYoshinobu Inoue 
3243f95d4633SHajimu UMEMOTO 	case IPV6_2292RTHDR:
324482cd038dSYoshinobu Inoue 	case IPV6_RTHDR:
324533841545SHajimu UMEMOTO 	{
324633841545SHajimu UMEMOTO 		struct ip6_rthdr *rth;
324733841545SHajimu UMEMOTO 		int rthlen;
324833841545SHajimu UMEMOTO 
3249f95d4633SHajimu UMEMOTO 		if (len == 0) {
3250f95d4633SHajimu UMEMOTO 			ip6_clearpktopts(opt, IPV6_RTHDR);
3251f95d4633SHajimu UMEMOTO 			break;	/* just remove the option */
3252f95d4633SHajimu UMEMOTO 		}
3253f95d4633SHajimu UMEMOTO 
3254f95d4633SHajimu UMEMOTO 		/* message length validation */
3255f95d4633SHajimu UMEMOTO 		if (len < sizeof(struct ip6_rthdr))
325682cd038dSYoshinobu Inoue 			return (EINVAL);
3257f95d4633SHajimu UMEMOTO 		rth = (struct ip6_rthdr *)buf;
325833841545SHajimu UMEMOTO 		rthlen = (rth->ip6r_len + 1) << 3;
3259f95d4633SHajimu UMEMOTO 		if (len != rthlen)
326082cd038dSYoshinobu Inoue 			return (EINVAL);
326133841545SHajimu UMEMOTO 
326233841545SHajimu UMEMOTO 		switch (rth->ip6r_type) {
326382cd038dSYoshinobu Inoue 		case IPV6_RTHDR_TYPE_0:
3264f95d4633SHajimu UMEMOTO 			if (rth->ip6r_len == 0)	/* must contain one addr */
326533841545SHajimu UMEMOTO 				return (EINVAL);
3266f95d4633SHajimu UMEMOTO 			if (rth->ip6r_len % 2) /* length must be even */
326733841545SHajimu UMEMOTO 				return (EINVAL);
326833841545SHajimu UMEMOTO 			if (rth->ip6r_len / 2 != rth->ip6r_segleft)
326982cd038dSYoshinobu Inoue 				return (EINVAL);
327082cd038dSYoshinobu Inoue 			break;
327182cd038dSYoshinobu Inoue 		default:
327233841545SHajimu UMEMOTO 			return (EINVAL);	/* not supported */
327382cd038dSYoshinobu Inoue 		}
327433841545SHajimu UMEMOTO 
3275f95d4633SHajimu UMEMOTO 		/* turn off the previous option */
3276f95d4633SHajimu UMEMOTO 		ip6_clearpktopts(opt, IPV6_RTHDR);
3277f95d4633SHajimu UMEMOTO 		if (sticky) {
3278f95d4633SHajimu UMEMOTO 			opt->ip6po_rthdr = malloc(rthlen, M_IP6OPT, M_WAITOK);
327933841545SHajimu UMEMOTO 			bcopy(rth, opt->ip6po_rthdr, rthlen);
328033841545SHajimu UMEMOTO 		} else
328133841545SHajimu UMEMOTO 			opt->ip6po_rthdr = rth;
328233841545SHajimu UMEMOTO 
328382cd038dSYoshinobu Inoue 		break;
328433841545SHajimu UMEMOTO 	}
328582cd038dSYoshinobu Inoue 
3286f95d4633SHajimu UMEMOTO 	case IPV6_USE_MIN_MTU:
3287f95d4633SHajimu UMEMOTO 		if (len != sizeof(int))
3288f95d4633SHajimu UMEMOTO 			return (EINVAL);
3289f95d4633SHajimu UMEMOTO 		minmtupolicy = *(int *)buf;
3290f95d4633SHajimu UMEMOTO 		if (minmtupolicy != IP6PO_MINMTU_MCASTONLY &&
3291f95d4633SHajimu UMEMOTO 		    minmtupolicy != IP6PO_MINMTU_DISABLE &&
3292f95d4633SHajimu UMEMOTO 		    minmtupolicy != IP6PO_MINMTU_ALL) {
3293f95d4633SHajimu UMEMOTO 			return (EINVAL);
3294f95d4633SHajimu UMEMOTO 		}
3295f95d4633SHajimu UMEMOTO 		opt->ip6po_minmtu = minmtupolicy;
3296f95d4633SHajimu UMEMOTO 		break;
3297f95d4633SHajimu UMEMOTO 
3298f95d4633SHajimu UMEMOTO 	case IPV6_DONTFRAG:
3299f95d4633SHajimu UMEMOTO 		if (len != sizeof(int))
3300f95d4633SHajimu UMEMOTO 			return (EINVAL);
3301f95d4633SHajimu UMEMOTO 
3302f95d4633SHajimu UMEMOTO 		if (uproto == IPPROTO_TCP || *(int *)buf == 0) {
3303f95d4633SHajimu UMEMOTO 			/*
3304f95d4633SHajimu UMEMOTO 			 * we ignore this option for TCP sockets.
3305f95d4633SHajimu UMEMOTO 			 * (rfc2292bis leaves this case unspecified.)
3306f95d4633SHajimu UMEMOTO 			 */
3307f95d4633SHajimu UMEMOTO 			opt->ip6po_flags &= ~IP6PO_DONTFRAG;
3308f95d4633SHajimu UMEMOTO 		} else
3309f95d4633SHajimu UMEMOTO 			opt->ip6po_flags |= IP6PO_DONTFRAG;
3310f95d4633SHajimu UMEMOTO 		break;
3311f95d4633SHajimu UMEMOTO 
3312f95d4633SHajimu UMEMOTO 	case IPV6_PREFER_TEMPADDR:
3313f95d4633SHajimu UMEMOTO 		if (len != sizeof(int))
3314f95d4633SHajimu UMEMOTO 			return (EINVAL);
3315f95d4633SHajimu UMEMOTO 		preftemp = *(int *)buf;
3316f95d4633SHajimu UMEMOTO 		if (preftemp != IP6PO_TEMPADDR_SYSTEM &&
3317f95d4633SHajimu UMEMOTO 		    preftemp != IP6PO_TEMPADDR_NOTPREFER &&
3318f95d4633SHajimu UMEMOTO 		    preftemp != IP6PO_TEMPADDR_PREFER) {
3319f95d4633SHajimu UMEMOTO 			return (EINVAL);
3320f95d4633SHajimu UMEMOTO 		}
3321f95d4633SHajimu UMEMOTO 		opt->ip6po_prefer_tempaddr = preftemp;
3322f95d4633SHajimu UMEMOTO 		break;
3323f95d4633SHajimu UMEMOTO 
332482cd038dSYoshinobu Inoue 	default:
332582cd038dSYoshinobu Inoue 		return (ENOPROTOOPT);
3326f95d4633SHajimu UMEMOTO 	} /* end of switch */
332782cd038dSYoshinobu Inoue 
332882cd038dSYoshinobu Inoue 	return (0);
332982cd038dSYoshinobu Inoue }
333082cd038dSYoshinobu Inoue 
333182cd038dSYoshinobu Inoue /*
333282cd038dSYoshinobu Inoue  * Routine called from ip6_output() to loop back a copy of an IP6 multicast
333382cd038dSYoshinobu Inoue  * packet to the input queue of a specified interface.  Note that this
333482cd038dSYoshinobu Inoue  * calls the output routine of the loopback "driver", but with an interface
333582cd038dSYoshinobu Inoue  * pointer that might NOT be &loif -- easier than replicating that code here.
333682cd038dSYoshinobu Inoue  */
333782cd038dSYoshinobu Inoue void
333882cd038dSYoshinobu Inoue ip6_mloopback(ifp, m, dst)
333982cd038dSYoshinobu Inoue 	struct ifnet *ifp;
334033841545SHajimu UMEMOTO 	struct mbuf *m;
334133841545SHajimu UMEMOTO 	struct sockaddr_in6 *dst;
334282cd038dSYoshinobu Inoue {
334382cd038dSYoshinobu Inoue 	struct mbuf *copym;
3344686cdd19SJun-ichiro itojun Hagino 	struct ip6_hdr *ip6;
334582cd038dSYoshinobu Inoue 
334682cd038dSYoshinobu Inoue 	copym = m_copy(m, 0, M_COPYALL);
3347686cdd19SJun-ichiro itojun Hagino 	if (copym == NULL)
3348686cdd19SJun-ichiro itojun Hagino 		return;
3349686cdd19SJun-ichiro itojun Hagino 
3350686cdd19SJun-ichiro itojun Hagino 	/*
3351686cdd19SJun-ichiro itojun Hagino 	 * Make sure to deep-copy IPv6 header portion in case the data
3352686cdd19SJun-ichiro itojun Hagino 	 * is in an mbuf cluster, so that we can safely override the IPv6
3353686cdd19SJun-ichiro itojun Hagino 	 * header portion later.
3354686cdd19SJun-ichiro itojun Hagino 	 */
3355686cdd19SJun-ichiro itojun Hagino 	if ((copym->m_flags & M_EXT) != 0 ||
3356686cdd19SJun-ichiro itojun Hagino 	    copym->m_len < sizeof(struct ip6_hdr)) {
3357686cdd19SJun-ichiro itojun Hagino 		copym = m_pullup(copym, sizeof(struct ip6_hdr));
3358686cdd19SJun-ichiro itojun Hagino 		if (copym == NULL)
3359686cdd19SJun-ichiro itojun Hagino 			return;
336082cd038dSYoshinobu Inoue 	}
3361686cdd19SJun-ichiro itojun Hagino 
3362686cdd19SJun-ichiro itojun Hagino #ifdef DIAGNOSTIC
3363686cdd19SJun-ichiro itojun Hagino 	if (copym->m_len < sizeof(*ip6)) {
3364686cdd19SJun-ichiro itojun Hagino 		m_freem(copym);
3365686cdd19SJun-ichiro itojun Hagino 		return;
3366686cdd19SJun-ichiro itojun Hagino 	}
3367686cdd19SJun-ichiro itojun Hagino #endif
3368686cdd19SJun-ichiro itojun Hagino 
3369686cdd19SJun-ichiro itojun Hagino 	ip6 = mtod(copym, struct ip6_hdr *);
337033841545SHajimu UMEMOTO 	/*
337133841545SHajimu UMEMOTO 	 * clear embedded scope identifiers if necessary.
337233841545SHajimu UMEMOTO 	 * in6_clearscope will touch the addresses only when necessary.
337333841545SHajimu UMEMOTO 	 */
337433841545SHajimu UMEMOTO 	in6_clearscope(&ip6->ip6_src);
337533841545SHajimu UMEMOTO 	in6_clearscope(&ip6->ip6_dst);
3376686cdd19SJun-ichiro itojun Hagino 
33777efe5d92SHajimu UMEMOTO 	(void)if_simloop(ifp, copym, dst->sin6_family, NULL);
337882cd038dSYoshinobu Inoue }
337982cd038dSYoshinobu Inoue 
338082cd038dSYoshinobu Inoue /*
338182cd038dSYoshinobu Inoue  * Chop IPv6 header off from the payload.
338282cd038dSYoshinobu Inoue  */
338382cd038dSYoshinobu Inoue static int
338482cd038dSYoshinobu Inoue ip6_splithdr(m, exthdrs)
338582cd038dSYoshinobu Inoue 	struct mbuf *m;
338682cd038dSYoshinobu Inoue 	struct ip6_exthdrs *exthdrs;
338782cd038dSYoshinobu Inoue {
338882cd038dSYoshinobu Inoue 	struct mbuf *mh;
338982cd038dSYoshinobu Inoue 	struct ip6_hdr *ip6;
339082cd038dSYoshinobu Inoue 
339182cd038dSYoshinobu Inoue 	ip6 = mtod(m, struct ip6_hdr *);
339282cd038dSYoshinobu Inoue 	if (m->m_len > sizeof(*ip6)) {
3393a163d034SWarner Losh 		MGETHDR(mh, M_DONTWAIT, MT_HEADER);
339482cd038dSYoshinobu Inoue 		if (mh == 0) {
339582cd038dSYoshinobu Inoue 			m_freem(m);
339682cd038dSYoshinobu Inoue 			return ENOBUFS;
339782cd038dSYoshinobu Inoue 		}
33989967cafcSSam Leffler 		M_MOVE_PKTHDR(mh, m);
339982cd038dSYoshinobu Inoue 		MH_ALIGN(mh, sizeof(*ip6));
340082cd038dSYoshinobu Inoue 		m->m_len -= sizeof(*ip6);
340182cd038dSYoshinobu Inoue 		m->m_data += sizeof(*ip6);
340282cd038dSYoshinobu Inoue 		mh->m_next = m;
340382cd038dSYoshinobu Inoue 		m = mh;
340482cd038dSYoshinobu Inoue 		m->m_len = sizeof(*ip6);
340582cd038dSYoshinobu Inoue 		bcopy((caddr_t)ip6, mtod(m, caddr_t), sizeof(*ip6));
340682cd038dSYoshinobu Inoue 	}
340782cd038dSYoshinobu Inoue 	exthdrs->ip6e_ip6 = m;
340882cd038dSYoshinobu Inoue 	return 0;
340982cd038dSYoshinobu Inoue }
341082cd038dSYoshinobu Inoue 
341182cd038dSYoshinobu Inoue /*
341282cd038dSYoshinobu Inoue  * Compute IPv6 extension header length.
341382cd038dSYoshinobu Inoue  */
341482cd038dSYoshinobu Inoue int
341582cd038dSYoshinobu Inoue ip6_optlen(in6p)
341682cd038dSYoshinobu Inoue 	struct in6pcb *in6p;
341782cd038dSYoshinobu Inoue {
341882cd038dSYoshinobu Inoue 	int len;
341982cd038dSYoshinobu Inoue 
342082cd038dSYoshinobu Inoue 	if (!in6p->in6p_outputopts)
342182cd038dSYoshinobu Inoue 		return 0;
342282cd038dSYoshinobu Inoue 
342382cd038dSYoshinobu Inoue 	len = 0;
342482cd038dSYoshinobu Inoue #define elen(x) \
342582cd038dSYoshinobu Inoue     (((struct ip6_ext *)(x)) ? (((struct ip6_ext *)(x))->ip6e_len + 1) << 3 : 0)
342682cd038dSYoshinobu Inoue 
342782cd038dSYoshinobu Inoue 	len += elen(in6p->in6p_outputopts->ip6po_hbh);
342833841545SHajimu UMEMOTO 	if (in6p->in6p_outputopts->ip6po_rthdr)
342933841545SHajimu UMEMOTO 		/* dest1 is valid with rthdr only */
343082cd038dSYoshinobu Inoue 		len += elen(in6p->in6p_outputopts->ip6po_dest1);
343182cd038dSYoshinobu Inoue 	len += elen(in6p->in6p_outputopts->ip6po_rthdr);
343282cd038dSYoshinobu Inoue 	len += elen(in6p->in6p_outputopts->ip6po_dest2);
343382cd038dSYoshinobu Inoue 	return len;
343482cd038dSYoshinobu Inoue #undef elen
343582cd038dSYoshinobu Inoue }
3436