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