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