in6_pcb.c revision 1.63 1 1.63 simonb /* $NetBSD: in6_pcb.c,v 1.63 2004/04/25 16:42:42 simonb Exp $ */
2 1.35 itojun /* $KAME: in6_pcb.c,v 1.84 2001/02/08 18:02:08 itojun Exp $ */
3 1.5 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.23 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.23 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, 1991, 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.54 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 * @(#)in_pcb.c 8.2 (Berkeley) 1/4/94
62 1.2 itojun */
63 1.44 lukem
64 1.44 lukem #include <sys/cdefs.h>
65 1.63 simonb __KERNEL_RCSID(0, "$NetBSD: in6_pcb.c,v 1.63 2004/04/25 16:42:42 simonb Exp $");
66 1.7 thorpej
67 1.53 perry #include "opt_inet.h"
68 1.7 thorpej #include "opt_ipsec.h"
69 1.2 itojun
70 1.2 itojun #include <sys/param.h>
71 1.2 itojun #include <sys/systm.h>
72 1.2 itojun #include <sys/malloc.h>
73 1.2 itojun #include <sys/mbuf.h>
74 1.2 itojun #include <sys/protosw.h>
75 1.2 itojun #include <sys/socket.h>
76 1.2 itojun #include <sys/socketvar.h>
77 1.2 itojun #include <sys/ioctl.h>
78 1.2 itojun #include <sys/errno.h>
79 1.2 itojun #include <sys/time.h>
80 1.2 itojun #include <sys/proc.h>
81 1.2 itojun
82 1.2 itojun #include <net/if.h>
83 1.2 itojun #include <net/route.h>
84 1.2 itojun
85 1.2 itojun #include <netinet/in.h>
86 1.2 itojun #include <netinet/in_var.h>
87 1.2 itojun #include <netinet/in_systm.h>
88 1.2 itojun #include <netinet/ip.h>
89 1.2 itojun #include <netinet/in_pcb.h>
90 1.19 itojun #include <netinet/ip6.h>
91 1.11 itojun #include <netinet6/ip6_var.h>
92 1.2 itojun #include <netinet6/in6_pcb.h>
93 1.2 itojun #include <netinet6/nd6.h>
94 1.2 itojun
95 1.2 itojun #include "loop.h"
96 1.2 itojun extern struct ifnet loif[NLOOP];
97 1.8 itojun #include "faith.h"
98 1.2 itojun
99 1.2 itojun #ifdef IPSEC
100 1.2 itojun #include <netinet6/ipsec.h>
101 1.2 itojun #include <netkey/key.h>
102 1.2 itojun #endif /* IPSEC */
103 1.2 itojun
104 1.2 itojun struct in6_addr zeroin6_addr;
105 1.30 itojun
106 1.60 itojun #define IN6PCBHASH_PORT(table, lport) \
107 1.60 itojun &(table)->inpt_porthashtbl[ntohs(lport) & (table)->inpt_porthash]
108 1.56 itojun #define IN6PCBHASH_BIND(table, laddr, lport) \
109 1.56 itojun &(table)->inpt_bindhashtbl[ \
110 1.56 itojun (((laddr)->s6_addr32[0] ^ (laddr)->s6_addr32[1] ^ \
111 1.56 itojun (laddr)->s6_addr32[2] ^ (laddr)->s6_addr32[3]) + ntohs(lport)) & \
112 1.56 itojun (table)->inpt_bindhash]
113 1.56 itojun #define IN6PCBHASH_CONNECT(table, faddr, fport, laddr, lport) \
114 1.56 itojun &(table)->inpt_bindhashtbl[ \
115 1.56 itojun ((((faddr)->s6_addr32[0] ^ (faddr)->s6_addr32[1] ^ \
116 1.56 itojun (faddr)->s6_addr32[2] ^ (faddr)->s6_addr32[3]) + ntohs(fport)) + \
117 1.56 itojun (((laddr)->s6_addr32[0] ^ (laddr)->s6_addr32[1] ^ \
118 1.56 itojun (laddr)->s6_addr32[2] ^ (laddr)->s6_addr32[3]) + \
119 1.56 itojun ntohs(lport))) & (table)->inpt_bindhash]
120 1.56 itojun
121 1.30 itojun int ip6_anonportmin = IPV6PORT_ANONMIN;
122 1.30 itojun int ip6_anonportmax = IPV6PORT_ANONMAX;
123 1.30 itojun int ip6_lowportmin = IPV6PORT_RESERVEDMIN;
124 1.30 itojun int ip6_lowportmax = IPV6PORT_RESERVEDMAX;
125 1.2 itojun
126 1.63 simonb POOL_INIT(in6pcb_pool, sizeof(struct in6pcb), 0, 0, 0, "in6pcbpl", NULL);
127 1.56 itojun
128 1.56 itojun void
129 1.56 itojun in6_pcbinit(table, bindhashsize, connecthashsize)
130 1.56 itojun struct inpcbtable *table;
131 1.56 itojun int bindhashsize, connecthashsize;
132 1.56 itojun {
133 1.56 itojun
134 1.56 itojun in_pcbinit(table, bindhashsize, connecthashsize);
135 1.56 itojun table->inpt_lastport = (u_int16_t)ip6_anonportmax;
136 1.56 itojun }
137 1.56 itojun
138 1.2 itojun int
139 1.56 itojun in6_pcballoc(so, v)
140 1.2 itojun struct socket *so;
141 1.56 itojun void *v;
142 1.2 itojun {
143 1.56 itojun struct inpcbtable *table = v;
144 1.2 itojun struct in6pcb *in6p;
145 1.46 itojun int s;
146 1.39 itojun #ifdef IPSEC
147 1.39 itojun int error;
148 1.39 itojun #endif
149 1.2 itojun
150 1.56 itojun in6p = pool_get(&in6pcb_pool, PR_NOWAIT);
151 1.2 itojun if (in6p == NULL)
152 1.52 itojun return (ENOBUFS);
153 1.2 itojun bzero((caddr_t)in6p, sizeof(*in6p));
154 1.56 itojun in6p->in6p_af = AF_INET6;
155 1.56 itojun in6p->in6p_table = table;
156 1.2 itojun in6p->in6p_socket = so;
157 1.2 itojun in6p->in6p_hops = -1; /* use kernel default */
158 1.2 itojun in6p->in6p_icmp6filt = NULL;
159 1.39 itojun #ifdef IPSEC
160 1.49 itojun error = ipsec_init_pcbpolicy(so, &in6p->in6p_sp);
161 1.39 itojun if (error != 0) {
162 1.56 itojun pool_put(&in6pcb_pool, in6p);
163 1.39 itojun return error;
164 1.39 itojun }
165 1.43 itojun #endif /* IPSEC */
166 1.46 itojun s = splnet();
167 1.56 itojun CIRCLEQ_INSERT_HEAD(&table->inpt_queue, (struct inpcb_hdr*)in6p,
168 1.56 itojun inph_queue);
169 1.60 itojun LIST_INSERT_HEAD(IN6PCBHASH_PORT(table, in6p->in6p_lport),
170 1.60 itojun &in6p->in6p_head, inph_lhash);
171 1.56 itojun in6_pcbstate(in6p, IN6P_ATTACHED);
172 1.46 itojun splx(s);
173 1.41 itojun if (ip6_v6only)
174 1.41 itojun in6p->in6p_flags |= IN6P_IPV6_V6ONLY;
175 1.2 itojun so->so_pcb = (caddr_t)in6p;
176 1.52 itojun return (0);
177 1.2 itojun }
178 1.2 itojun
179 1.2 itojun int
180 1.56 itojun in6_pcbbind(v, nam, p)
181 1.56 itojun void *v;
182 1.2 itojun struct mbuf *nam;
183 1.24 itojun struct proc *p;
184 1.2 itojun {
185 1.56 itojun struct in6pcb *in6p = v;
186 1.2 itojun struct socket *so = in6p->in6p_socket;
187 1.56 itojun struct inpcbtable *table = in6p->in6p_table;
188 1.2 itojun struct sockaddr_in6 *sin6 = (struct sockaddr_in6 *)NULL;
189 1.18 itojun u_int16_t lport = 0;
190 1.2 itojun int wild = 0, reuseport = (so->so_options & SO_REUSEPORT);
191 1.2 itojun
192 1.56 itojun if (in6p->in6p_af != AF_INET6)
193 1.56 itojun return (EINVAL);
194 1.56 itojun
195 1.10 itojun if (in6p->in6p_lport || !IN6_IS_ADDR_UNSPECIFIED(&in6p->in6p_laddr))
196 1.52 itojun return (EINVAL);
197 1.2 itojun if ((so->so_options & (SO_REUSEADDR|SO_REUSEPORT)) == 0 &&
198 1.2 itojun ((so->so_proto->pr_flags & PR_CONNREQUIRED) == 0 ||
199 1.2 itojun (so->so_options & SO_ACCEPTCONN) == 0))
200 1.56 itojun wild = 1;
201 1.2 itojun if (nam) {
202 1.2 itojun sin6 = mtod(nam, struct sockaddr_in6 *);
203 1.2 itojun if (nam->m_len != sizeof(*sin6))
204 1.52 itojun return (EINVAL);
205 1.2 itojun /*
206 1.2 itojun * We should check the family, but old programs
207 1.2 itojun * incorrectly fail to intialize it.
208 1.2 itojun */
209 1.2 itojun if (sin6->sin6_family != AF_INET6)
210 1.52 itojun return (EAFNOSUPPORT);
211 1.22 itojun
212 1.56 itojun #ifndef INET
213 1.22 itojun if (IN6_IS_ADDR_V4MAPPED(&sin6->sin6_addr))
214 1.52 itojun return (EADDRNOTAVAIL);
215 1.56 itojun #endif
216 1.2 itojun
217 1.29 itojun /* KAME hack: embed scopeid */
218 1.29 itojun if (in6_embedscope(&sin6->sin6_addr, sin6, in6p, NULL) != 0)
219 1.29 itojun return EINVAL;
220 1.29 itojun /* this must be cleared for ifa_ifwithaddr() */
221 1.29 itojun sin6->sin6_scope_id = 0;
222 1.2 itojun
223 1.2 itojun lport = sin6->sin6_port;
224 1.2 itojun if (IN6_IS_ADDR_MULTICAST(&sin6->sin6_addr)) {
225 1.2 itojun /*
226 1.2 itojun * Treat SO_REUSEADDR as SO_REUSEPORT for multicast;
227 1.2 itojun * allow compepte duplication of binding if
228 1.2 itojun * SO_REUSEPORT is set, or if SO_REUSEADDR is set
229 1.2 itojun * and a multicast address is bound on both
230 1.2 itojun * new and duplicated sockets.
231 1.2 itojun */
232 1.2 itojun if (so->so_options & SO_REUSEADDR)
233 1.2 itojun reuseport = SO_REUSEADDR|SO_REUSEPORT;
234 1.41 itojun }
235 1.41 itojun else if (IN6_IS_ADDR_V4MAPPED(&sin6->sin6_addr)) {
236 1.56 itojun if ((in6p->in6p_flags & IN6P_IPV6_V6ONLY) != 0)
237 1.56 itojun return (EINVAL);
238 1.56 itojun if (sin6->sin6_addr.s6_addr32[3]) {
239 1.56 itojun struct sockaddr_in sin;
240 1.56 itojun
241 1.56 itojun bzero(&sin, sizeof(sin));
242 1.56 itojun sin.sin_len = sizeof(sin);
243 1.56 itojun sin.sin_family = AF_INET;
244 1.56 itojun bcopy(&sin6->sin6_addr.s6_addr32[3],
245 1.56 itojun &sin.sin_addr, sizeof(sin.sin_addr));
246 1.56 itojun if (ifa_ifwithaddr((struct sockaddr *)&sin) == 0)
247 1.56 itojun return EADDRNOTAVAIL;
248 1.56 itojun }
249 1.41 itojun }
250 1.41 itojun else if (!IN6_IS_ADDR_UNSPECIFIED(&sin6->sin6_addr)) {
251 1.2 itojun struct ifaddr *ia = NULL;
252 1.2 itojun
253 1.2 itojun sin6->sin6_port = 0; /* yech... */
254 1.36 itojun if ((in6p->in6p_flags & IN6P_FAITH) == 0 &&
255 1.36 itojun (ia = ifa_ifwithaddr((struct sockaddr *)sin6)) == 0)
256 1.52 itojun return (EADDRNOTAVAIL);
257 1.2 itojun
258 1.2 itojun /*
259 1.45 itojun * bind to an anycast address might accidentally
260 1.45 itojun * cause sending a packet with an anycast source
261 1.45 itojun * address, so we forbid it.
262 1.50 itojun *
263 1.50 itojun * We should allow to bind to a deprecated address,
264 1.50 itojun * since the application dare to use it.
265 1.50 itojun * But, can we assume that they are careful enough
266 1.50 itojun * to check if the address is deprecated or not?
267 1.50 itojun * Maybe, as a safeguard, we should have a setsockopt
268 1.50 itojun * flag to control the bind(2) behavior against
269 1.50 itojun * deprecated addresses (default: forbid bind(2)).
270 1.2 itojun */
271 1.20 itojun if (ia &&
272 1.20 itojun ((struct in6_ifaddr *)ia)->ia6_flags &
273 1.50 itojun (IN6_IFF_ANYCAST|IN6_IFF_NOTREADY|IN6_IFF_DETACHED))
274 1.52 itojun return (EADDRNOTAVAIL);
275 1.2 itojun }
276 1.2 itojun if (lport) {
277 1.13 itojun #ifndef IPNOPRIVPORTS
278 1.29 itojun int priv;
279 1.29 itojun
280 1.29 itojun /*
281 1.29 itojun * NOTE: all operating systems use suser() for
282 1.29 itojun * privilege check! do not rewrite it into SS_PRIV.
283 1.29 itojun */
284 1.29 itojun priv = (p && !suser(p->p_ucred, &p->p_acflag)) ? 1 : 0;
285 1.2 itojun /* GROSS */
286 1.29 itojun if (ntohs(lport) < IPV6PORT_RESERVED && !priv)
287 1.52 itojun return (EACCES);
288 1.13 itojun #endif
289 1.2 itojun
290 1.2 itojun if (IN6_IS_ADDR_V4MAPPED(&sin6->sin6_addr)) {
291 1.56 itojun #ifdef INET
292 1.2 itojun struct inpcb *t;
293 1.2 itojun
294 1.56 itojun t = in_pcblookup_port(table,
295 1.56 itojun *(struct in_addr *)&sin6->sin6_addr.s6_addr32[3],
296 1.56 itojun lport, wild);
297 1.2 itojun if (t && (reuseport & t->inp_socket->so_options) == 0)
298 1.56 itojun return (EADDRINUSE);
299 1.56 itojun #else
300 1.56 itojun return (EADDRNOTAVAIL);
301 1.2 itojun #endif
302 1.56 itojun }
303 1.56 itojun
304 1.42 itojun {
305 1.2 itojun struct in6pcb *t;
306 1.2 itojun
307 1.56 itojun t = in6_pcblookup_port(table, &sin6->sin6_addr,
308 1.56 itojun lport, wild);
309 1.2 itojun if (t && (reuseport & t->in6p_socket->so_options) == 0)
310 1.52 itojun return (EADDRINUSE);
311 1.2 itojun }
312 1.2 itojun }
313 1.2 itojun in6p->in6p_laddr = sin6->sin6_addr;
314 1.2 itojun }
315 1.10 itojun
316 1.2 itojun if (lport == 0) {
317 1.10 itojun int e;
318 1.56 itojun e = in6_pcbsetport(&in6p->in6p_laddr, in6p, p);
319 1.56 itojun if (e != 0)
320 1.52 itojun return (e);
321 1.56 itojun } else {
322 1.56 itojun in6p->in6p_lport = lport;
323 1.56 itojun in6_pcbstate(in6p, IN6P_BOUND);
324 1.10 itojun }
325 1.10 itojun
326 1.60 itojun LIST_REMOVE(&in6p->in6p_head, inph_lhash);
327 1.60 itojun LIST_INSERT_HEAD(IN6PCBHASH_PORT(table, in6p->in6p_lport),
328 1.60 itojun &in6p->in6p_head, inph_lhash);
329 1.60 itojun
330 1.57 itojun #if 0
331 1.57 itojun in6p->in6p_flowinfo = 0; /* XXX */
332 1.57 itojun #endif
333 1.52 itojun return (0);
334 1.10 itojun }
335 1.10 itojun
336 1.10 itojun /*
337 1.2 itojun * Connect from a socket to a specified address.
338 1.2 itojun * Both address and port must be specified in argument sin6.
339 1.2 itojun * If don't have a local address for this socket yet,
340 1.2 itojun * then pick one.
341 1.2 itojun */
342 1.2 itojun int
343 1.56 itojun in6_pcbconnect(v, nam)
344 1.56 itojun void *v;
345 1.2 itojun struct mbuf *nam;
346 1.2 itojun {
347 1.56 itojun struct in6pcb *in6p = v;
348 1.2 itojun struct in6_addr *in6a = NULL;
349 1.2 itojun struct sockaddr_in6 *sin6 = mtod(nam, struct sockaddr_in6 *);
350 1.2 itojun struct ifnet *ifp = NULL; /* outgoing interface */
351 1.2 itojun int error = 0;
352 1.31 itojun #ifdef INET
353 1.2 itojun struct in6_addr mapped;
354 1.31 itojun #endif
355 1.26 itojun struct sockaddr_in6 tmp;
356 1.2 itojun
357 1.2 itojun (void)&in6a; /* XXX fool gcc */
358 1.2 itojun
359 1.56 itojun if (in6p->in6p_af != AF_INET6)
360 1.56 itojun return (EINVAL);
361 1.56 itojun
362 1.2 itojun if (nam->m_len != sizeof(*sin6))
363 1.52 itojun return (EINVAL);
364 1.2 itojun if (sin6->sin6_family != AF_INET6)
365 1.52 itojun return (EAFNOSUPPORT);
366 1.2 itojun if (sin6->sin6_port == 0)
367 1.52 itojun return (EADDRNOTAVAIL);
368 1.2 itojun
369 1.2 itojun /* sanity check for mapped address case */
370 1.2 itojun if (IN6_IS_ADDR_V4MAPPED(&sin6->sin6_addr)) {
371 1.41 itojun if ((in6p->in6p_flags & IN6P_IPV6_V6ONLY) != 0)
372 1.41 itojun return EINVAL;
373 1.2 itojun if (IN6_IS_ADDR_UNSPECIFIED(&in6p->in6p_laddr))
374 1.2 itojun in6p->in6p_laddr.s6_addr16[5] = htons(0xffff);
375 1.2 itojun if (!IN6_IS_ADDR_V4MAPPED(&in6p->in6p_laddr))
376 1.2 itojun return EINVAL;
377 1.41 itojun } else
378 1.41 itojun {
379 1.2 itojun if (IN6_IS_ADDR_V4MAPPED(&in6p->in6p_laddr))
380 1.2 itojun return EINVAL;
381 1.2 itojun }
382 1.26 itojun
383 1.26 itojun /* protect *sin6 from overwrites */
384 1.26 itojun tmp = *sin6;
385 1.26 itojun sin6 = &tmp;
386 1.2 itojun
387 1.29 itojun /* KAME hack: embed scopeid */
388 1.29 itojun if (in6_embedscope(&sin6->sin6_addr, sin6, in6p, &ifp) != 0)
389 1.29 itojun return EINVAL;
390 1.2 itojun
391 1.2 itojun /* Source address selection. */
392 1.56 itojun if (IN6_IS_ADDR_V4MAPPED(&in6p->in6p_laddr) &&
393 1.56 itojun in6p->in6p_laddr.s6_addr32[3] == 0) {
394 1.31 itojun #ifdef INET
395 1.2 itojun struct sockaddr_in sin, *sinp;
396 1.2 itojun
397 1.2 itojun bzero(&sin, sizeof(sin));
398 1.2 itojun sin.sin_len = sizeof(sin);
399 1.2 itojun sin.sin_family = AF_INET;
400 1.2 itojun bcopy(&sin6->sin6_addr.s6_addr32[3], &sin.sin_addr,
401 1.2 itojun sizeof(sin.sin_addr));
402 1.2 itojun sinp = in_selectsrc(&sin, (struct route *)&in6p->in6p_route,
403 1.2 itojun in6p->in6p_socket->so_options, NULL, &error);
404 1.2 itojun if (sinp == 0) {
405 1.2 itojun if (error == 0)
406 1.2 itojun error = EADDRNOTAVAIL;
407 1.52 itojun return (error);
408 1.2 itojun }
409 1.2 itojun bzero(&mapped, sizeof(mapped));
410 1.2 itojun mapped.s6_addr16[5] = htons(0xffff);
411 1.2 itojun bcopy(&sinp->sin_addr, &mapped.s6_addr32[3], sizeof(sinp->sin_addr));
412 1.2 itojun in6a = &mapped;
413 1.31 itojun #else
414 1.31 itojun return EADDRNOTAVAIL;
415 1.31 itojun #endif
416 1.41 itojun } else
417 1.41 itojun {
418 1.10 itojun /*
419 1.10 itojun * XXX: in6_selectsrc might replace the bound local address
420 1.10 itojun * with the address specified by setsockopt(IPV6_PKTINFO).
421 1.10 itojun * Is it the intended behavior?
422 1.10 itojun */
423 1.2 itojun in6a = in6_selectsrc(sin6, in6p->in6p_outputopts,
424 1.10 itojun in6p->in6p_moptions,
425 1.10 itojun &in6p->in6p_route,
426 1.10 itojun &in6p->in6p_laddr, &error);
427 1.2 itojun if (in6a == 0) {
428 1.2 itojun if (error == 0)
429 1.2 itojun error = EADDRNOTAVAIL;
430 1.52 itojun return (error);
431 1.2 itojun }
432 1.2 itojun }
433 1.2 itojun if (in6p->in6p_route.ro_rt)
434 1.2 itojun ifp = in6p->in6p_route.ro_rt->rt_ifp;
435 1.2 itojun
436 1.10 itojun in6p->in6p_ip6.ip6_hlim = (u_int8_t)in6_selecthlim(in6p, ifp);
437 1.2 itojun
438 1.56 itojun if (in6_pcblookup_connect(in6p->in6p_table, &sin6->sin6_addr,
439 1.56 itojun sin6->sin6_port,
440 1.56 itojun IN6_IS_ADDR_UNSPECIFIED(&in6p->in6p_laddr) ? in6a : &in6p->in6p_laddr,
441 1.56 itojun in6p->in6p_lport, 0))
442 1.52 itojun return (EADDRINUSE);
443 1.56 itojun if (IN6_IS_ADDR_UNSPECIFIED(&in6p->in6p_laddr) ||
444 1.56 itojun (IN6_IS_ADDR_V4MAPPED(&in6p->in6p_laddr) &&
445 1.56 itojun in6p->in6p_laddr.s6_addr32[3] == 0))
446 1.41 itojun {
447 1.29 itojun if (in6p->in6p_lport == 0) {
448 1.24 itojun (void)in6_pcbbind(in6p, (struct mbuf *)0,
449 1.24 itojun (struct proc *)0);
450 1.29 itojun }
451 1.2 itojun in6p->in6p_laddr = *in6a;
452 1.2 itojun }
453 1.2 itojun in6p->in6p_faddr = sin6->sin6_addr;
454 1.2 itojun in6p->in6p_fport = sin6->sin6_port;
455 1.56 itojun in6_pcbstate(in6p, IN6P_CONNECTED);
456 1.57 itojun in6p->in6p_flowinfo &= ~IPV6_FLOWLABEL_MASK;
457 1.57 itojun if (ip6_auto_flowlabel)
458 1.57 itojun in6p->in6p_flowinfo |=
459 1.58 itojun (htonl(ip6_randomflowlabel()) & IPV6_FLOWLABEL_MASK);
460 1.40 itojun #ifdef IPSEC
461 1.40 itojun if (in6p->in6p_socket->so_type == SOCK_STREAM)
462 1.40 itojun ipsec_pcbconn(in6p->in6p_sp);
463 1.40 itojun #endif
464 1.52 itojun return (0);
465 1.2 itojun }
466 1.2 itojun
467 1.2 itojun void
468 1.2 itojun in6_pcbdisconnect(in6p)
469 1.2 itojun struct in6pcb *in6p;
470 1.2 itojun {
471 1.2 itojun bzero((caddr_t)&in6p->in6p_faddr, sizeof(in6p->in6p_faddr));
472 1.2 itojun in6p->in6p_fport = 0;
473 1.56 itojun in6_pcbstate(in6p, IN6P_BOUND);
474 1.57 itojun in6p->in6p_flowinfo &= ~IPV6_FLOWLABEL_MASK;
475 1.40 itojun #ifdef IPSEC
476 1.40 itojun ipsec_pcbdisconn(in6p->in6p_sp);
477 1.40 itojun #endif
478 1.61 itojun if (in6p->in6p_socket->so_state & SS_NOFDREF)
479 1.61 itojun in6_pcbdetach(in6p);
480 1.2 itojun }
481 1.2 itojun
482 1.2 itojun void
483 1.2 itojun in6_pcbdetach(in6p)
484 1.2 itojun struct in6pcb *in6p;
485 1.2 itojun {
486 1.2 itojun struct socket *so = in6p->in6p_socket;
487 1.46 itojun int s;
488 1.2 itojun
489 1.56 itojun if (in6p->in6p_af != AF_INET6)
490 1.56 itojun return;
491 1.56 itojun
492 1.2 itojun #ifdef IPSEC
493 1.2 itojun ipsec6_delete_pcbpolicy(in6p);
494 1.2 itojun #endif /* IPSEC */
495 1.2 itojun sotoin6pcb(so) = 0;
496 1.2 itojun sofree(so);
497 1.2 itojun if (in6p->in6p_options)
498 1.2 itojun m_freem(in6p->in6p_options);
499 1.2 itojun if (in6p->in6p_outputopts) {
500 1.2 itojun if (in6p->in6p_outputopts->ip6po_rthdr &&
501 1.2 itojun in6p->in6p_outputopts->ip6po_route.ro_rt)
502 1.2 itojun RTFREE(in6p->in6p_outputopts->ip6po_route.ro_rt);
503 1.2 itojun if (in6p->in6p_outputopts->ip6po_m)
504 1.2 itojun (void)m_free(in6p->in6p_outputopts->ip6po_m);
505 1.2 itojun free(in6p->in6p_outputopts, M_IP6OPT);
506 1.2 itojun }
507 1.2 itojun if (in6p->in6p_route.ro_rt)
508 1.2 itojun rtfree(in6p->in6p_route.ro_rt);
509 1.2 itojun ip6_freemoptions(in6p->in6p_moptions);
510 1.46 itojun s = splnet();
511 1.56 itojun in6_pcbstate(in6p, IN6P_ATTACHED);
512 1.60 itojun LIST_REMOVE(&in6p->in6p_head, inph_lhash);
513 1.56 itojun CIRCLEQ_REMOVE(&in6p->in6p_table->inpt_queue, &in6p->in6p_head,
514 1.56 itojun inph_queue);
515 1.46 itojun splx(s);
516 1.56 itojun pool_put(&in6pcb_pool, in6p);
517 1.2 itojun }
518 1.2 itojun
519 1.2 itojun void
520 1.2 itojun in6_setsockaddr(in6p, nam)
521 1.2 itojun struct in6pcb *in6p;
522 1.2 itojun struct mbuf *nam;
523 1.2 itojun {
524 1.2 itojun struct sockaddr_in6 *sin6;
525 1.2 itojun
526 1.56 itojun if (in6p->in6p_af != AF_INET6)
527 1.56 itojun return;
528 1.56 itojun
529 1.2 itojun nam->m_len = sizeof(*sin6);
530 1.2 itojun sin6 = mtod(nam, struct sockaddr_in6 *);
531 1.2 itojun bzero((caddr_t)sin6, sizeof(*sin6));
532 1.2 itojun sin6->sin6_family = AF_INET6;
533 1.2 itojun sin6->sin6_len = sizeof(struct sockaddr_in6);
534 1.2 itojun sin6->sin6_port = in6p->in6p_lport;
535 1.29 itojun /* KAME hack: recover scopeid */
536 1.29 itojun (void)in6_recoverscope(sin6, &in6p->in6p_laddr, NULL);
537 1.2 itojun }
538 1.2 itojun
539 1.2 itojun void
540 1.2 itojun in6_setpeeraddr(in6p, nam)
541 1.2 itojun struct in6pcb *in6p;
542 1.2 itojun struct mbuf *nam;
543 1.2 itojun {
544 1.2 itojun struct sockaddr_in6 *sin6;
545 1.2 itojun
546 1.56 itojun if (in6p->in6p_af != AF_INET6)
547 1.56 itojun return;
548 1.56 itojun
549 1.2 itojun nam->m_len = sizeof(*sin6);
550 1.2 itojun sin6 = mtod(nam, struct sockaddr_in6 *);
551 1.2 itojun bzero((caddr_t)sin6, sizeof(*sin6));
552 1.2 itojun sin6->sin6_family = AF_INET6;
553 1.2 itojun sin6->sin6_len = sizeof(struct sockaddr_in6);
554 1.2 itojun sin6->sin6_port = in6p->in6p_fport;
555 1.29 itojun /* KAME hack: recover scopeid */
556 1.29 itojun (void)in6_recoverscope(sin6, &in6p->in6p_faddr, NULL);
557 1.2 itojun }
558 1.2 itojun
559 1.2 itojun /*
560 1.2 itojun * Pass some notification to all connections of a protocol
561 1.2 itojun * associated with address dst. The local address and/or port numbers
562 1.2 itojun * may be specified to limit the search. The "usual action" will be
563 1.2 itojun * taken, depending on the ctlinput cmd. The caller must filter any
564 1.2 itojun * cmds that are uninteresting (e.g., no error in the map).
565 1.2 itojun * Call the protocol specific routine (if any) to report
566 1.2 itojun * any errors for each matching socket.
567 1.2 itojun *
568 1.6 itojun * Must be called at splsoftnet.
569 1.35 itojun *
570 1.35 itojun * Note: src (4th arg) carries the flowlabel value on the original IPv6
571 1.35 itojun * header, in sin6_flowinfo member.
572 1.2 itojun */
573 1.2 itojun int
574 1.56 itojun in6_pcbnotify(table, dst, fport_arg, src, lport_arg, cmd, cmdarg, notify)
575 1.56 itojun struct inpcbtable *table;
576 1.35 itojun struct sockaddr *dst, *src;
577 1.2 itojun u_int fport_arg, lport_arg;
578 1.2 itojun int cmd;
579 1.35 itojun void *cmdarg;
580 1.2 itojun void (*notify) __P((struct in6pcb *, int));
581 1.2 itojun {
582 1.20 itojun struct in6pcb *in6p, *nin6p;
583 1.35 itojun struct sockaddr_in6 sa6_src, *sa6_dst;
584 1.18 itojun u_int16_t fport = fport_arg, lport = lport_arg;
585 1.2 itojun int errno;
586 1.2 itojun int nmatch = 0;
587 1.35 itojun u_int32_t flowinfo;
588 1.2 itojun
589 1.59 christos if ((unsigned)cmd >= PRC_NCMDS || dst->sa_family != AF_INET6)
590 1.2 itojun return 0;
591 1.35 itojun
592 1.35 itojun sa6_dst = (struct sockaddr_in6 *)dst;
593 1.35 itojun if (IN6_IS_ADDR_UNSPECIFIED(&sa6_dst->sin6_addr))
594 1.2 itojun return 0;
595 1.2 itojun
596 1.2 itojun /*
597 1.35 itojun * note that src can be NULL when we get notify by local fragmentation.
598 1.35 itojun */
599 1.35 itojun sa6_src = (src == NULL) ? sa6_any : *(struct sockaddr_in6 *)src;
600 1.35 itojun flowinfo = sa6_src.sin6_flowinfo;
601 1.35 itojun
602 1.35 itojun /*
603 1.2 itojun * Redirects go to all references to the destination,
604 1.20 itojun * and use in6_rtchange to invalidate the route cache.
605 1.20 itojun * Dead host indications: also use in6_rtchange to invalidate
606 1.20 itojun * the cache, and deliver the error to all the sockets.
607 1.2 itojun * Otherwise, if we have knowledge of the local port and address,
608 1.2 itojun * deliver only to that socket.
609 1.2 itojun */
610 1.2 itojun if (PRC_IS_REDIRECT(cmd) || cmd == PRC_HOSTDEAD) {
611 1.2 itojun fport = 0;
612 1.2 itojun lport = 0;
613 1.35 itojun bzero((caddr_t)&sa6_src.sin6_addr, sizeof(sa6_src.sin6_addr));
614 1.20 itojun
615 1.35 itojun if (cmd != PRC_HOSTDEAD)
616 1.35 itojun notify = in6_rtchange;
617 1.2 itojun }
618 1.20 itojun
619 1.2 itojun errno = inet6ctlerrmap[cmd];
620 1.56 itojun for (in6p = (struct in6pcb *)CIRCLEQ_FIRST(&table->inpt_queue);
621 1.56 itojun in6p != (void *)&table->inpt_queue;
622 1.56 itojun in6p = nin6p) {
623 1.56 itojun nin6p = (struct in6pcb *)CIRCLEQ_NEXT(in6p, in6p_queue);
624 1.56 itojun
625 1.56 itojun if (in6p->in6p_af != AF_INET6)
626 1.56 itojun continue;
627 1.20 itojun
628 1.35 itojun /*
629 1.35 itojun * Under the following condition, notify of redirects
630 1.35 itojun * to the pcb, without making address matches against inpcb.
631 1.35 itojun * - redirect notification is arrived.
632 1.35 itojun * - the inpcb is unconnected.
633 1.35 itojun * - the inpcb is caching !RTF_HOST routing entry.
634 1.35 itojun * - the ICMPv6 notification is from the gateway cached in the
635 1.35 itojun * inpcb. i.e. ICMPv6 notification is from nexthop gateway
636 1.35 itojun * the inpcb used very recently.
637 1.35 itojun *
638 1.35 itojun * This is to improve interaction between netbsd/openbsd
639 1.35 itojun * redirect handling code, and inpcb route cache code.
640 1.35 itojun * without the clause, !RTF_HOST routing entry (which carries
641 1.35 itojun * gateway used by inpcb right before the ICMPv6 redirect)
642 1.35 itojun * will be cached forever in unconnected inpcb.
643 1.35 itojun *
644 1.35 itojun * There still is a question regarding to what is TRT:
645 1.35 itojun * - On bsdi/freebsd, RTF_HOST (cloned) routing entry will be
646 1.35 itojun * generated on packet output. inpcb will always cache
647 1.35 itojun * RTF_HOST routing entry so there's no need for the clause
648 1.35 itojun * (ICMPv6 redirect will update RTF_HOST routing entry,
649 1.35 itojun * and inpcb is caching it already).
650 1.35 itojun * However, bsdi/freebsd are vulnerable to local DoS attacks
651 1.35 itojun * due to the cloned routing entries.
652 1.35 itojun * - Specwise, "destination cache" is mentioned in RFC2461.
653 1.35 itojun * Jinmei says that it implies bsdi/freebsd behavior, itojun
654 1.35 itojun * is not really convinced.
655 1.35 itojun * - Having hiwat/lowat on # of cloned host route (redirect/
656 1.35 itojun * pmtud) may be a good idea. netbsd/openbsd has it. see
657 1.35 itojun * icmp6_mtudisc_update().
658 1.35 itojun */
659 1.35 itojun if ((PRC_IS_REDIRECT(cmd) || cmd == PRC_HOSTDEAD) &&
660 1.35 itojun IN6_IS_ADDR_UNSPECIFIED(&in6p->in6p_laddr) &&
661 1.35 itojun in6p->in6p_route.ro_rt &&
662 1.35 itojun !(in6p->in6p_route.ro_rt->rt_flags & RTF_HOST)) {
663 1.35 itojun struct sockaddr_in6 *dst6;
664 1.35 itojun
665 1.35 itojun dst6 = (struct sockaddr_in6 *)&in6p->in6p_route.ro_dst;
666 1.35 itojun if (IN6_ARE_ADDR_EQUAL(&dst6->sin6_addr,
667 1.35 itojun &sa6_dst->sin6_addr))
668 1.35 itojun goto do_notify;
669 1.20 itojun }
670 1.20 itojun
671 1.35 itojun /*
672 1.35 itojun * Detect if we should notify the error. If no source and
673 1.42 itojun * destination ports are specified, but non-zero flowinfo and
674 1.35 itojun * local address match, notify the error. This is the case
675 1.35 itojun * when the error is delivered with an encrypted buffer
676 1.35 itojun * by ESP. Otherwise, just compare addresses and ports
677 1.35 itojun * as usual.
678 1.35 itojun */
679 1.35 itojun if (lport == 0 && fport == 0 && flowinfo &&
680 1.35 itojun in6p->in6p_socket != NULL &&
681 1.35 itojun flowinfo == (in6p->in6p_flowinfo & IPV6_FLOWLABEL_MASK) &&
682 1.35 itojun IN6_ARE_ADDR_EQUAL(&in6p->in6p_laddr, &sa6_src.sin6_addr))
683 1.35 itojun goto do_notify;
684 1.35 itojun else if (!IN6_ARE_ADDR_EQUAL(&in6p->in6p_faddr,
685 1.35 itojun &sa6_dst->sin6_addr) ||
686 1.20 itojun in6p->in6p_socket == 0 ||
687 1.20 itojun (lport && in6p->in6p_lport != lport) ||
688 1.35 itojun (!IN6_IS_ADDR_UNSPECIFIED(&sa6_src.sin6_addr) &&
689 1.35 itojun !IN6_ARE_ADDR_EQUAL(&in6p->in6p_laddr,
690 1.35 itojun &sa6_src.sin6_addr)) ||
691 1.20 itojun (fport && in6p->in6p_fport != fport))
692 1.2 itojun continue;
693 1.20 itojun
694 1.35 itojun do_notify:
695 1.35 itojun if (notify)
696 1.35 itojun (*notify)(in6p, errno);
697 1.2 itojun nmatch++;
698 1.2 itojun }
699 1.2 itojun return nmatch;
700 1.16 thorpej }
701 1.16 thorpej
702 1.16 thorpej void
703 1.56 itojun in6_pcbpurgeif0(table, ifp)
704 1.56 itojun struct inpcbtable *table;
705 1.16 thorpej struct ifnet *ifp;
706 1.16 thorpej {
707 1.16 thorpej struct in6pcb *in6p, *nin6p;
708 1.37 itojun struct ip6_moptions *im6o;
709 1.37 itojun struct in6_multi_mship *imm, *nimm;
710 1.16 thorpej
711 1.56 itojun for (in6p = (struct in6pcb *)CIRCLEQ_FIRST(&table->inpt_queue);
712 1.56 itojun in6p != (void *)&table->inpt_queue;
713 1.56 itojun in6p = nin6p) {
714 1.56 itojun nin6p = (struct in6pcb *)CIRCLEQ_NEXT(in6p, in6p_queue);
715 1.56 itojun if (in6p->in6p_af != AF_INET6)
716 1.56 itojun continue;
717 1.56 itojun
718 1.37 itojun im6o = in6p->in6p_moptions;
719 1.37 itojun if (im6o) {
720 1.37 itojun /*
721 1.37 itojun * Unselect the outgoing interface if it is being
722 1.37 itojun * detached.
723 1.37 itojun */
724 1.37 itojun if (im6o->im6o_multicast_ifp == ifp)
725 1.37 itojun im6o->im6o_multicast_ifp = NULL;
726 1.37 itojun
727 1.37 itojun /*
728 1.37 itojun * Drop multicast group membership if we joined
729 1.37 itojun * through the interface being detached.
730 1.37 itojun * XXX controversial - is it really legal for kernel
731 1.37 itojun * to force this?
732 1.37 itojun */
733 1.37 itojun for (imm = im6o->im6o_memberships.lh_first;
734 1.37 itojun imm != NULL; imm = nimm) {
735 1.37 itojun nimm = imm->i6mm_chain.le_next;
736 1.37 itojun if (imm->i6mm_maddr->in6m_ifp == ifp) {
737 1.37 itojun LIST_REMOVE(imm, i6mm_chain);
738 1.45 itojun in6_leavegroup(imm);
739 1.37 itojun }
740 1.37 itojun }
741 1.37 itojun }
742 1.38 itojun }
743 1.38 itojun }
744 1.38 itojun
745 1.38 itojun void
746 1.56 itojun in6_pcbpurgeif(table, ifp)
747 1.56 itojun struct inpcbtable *table;
748 1.38 itojun struct ifnet *ifp;
749 1.38 itojun {
750 1.38 itojun struct in6pcb *in6p, *nin6p;
751 1.38 itojun
752 1.56 itojun for (in6p = (struct in6pcb *)CIRCLEQ_FIRST(&table->inpt_queue);
753 1.56 itojun in6p != (void *)&table->inpt_queue;
754 1.56 itojun in6p = nin6p) {
755 1.56 itojun nin6p = (struct in6pcb *)CIRCLEQ_NEXT(in6p, in6p_queue);
756 1.56 itojun if (in6p->in6p_af != AF_INET6)
757 1.56 itojun continue;
758 1.38 itojun if (in6p->in6p_route.ro_rt != NULL &&
759 1.38 itojun in6p->in6p_route.ro_rt->rt_ifp == ifp)
760 1.38 itojun in6_rtchange(in6p, 0);
761 1.16 thorpej }
762 1.2 itojun }
763 1.2 itojun
764 1.2 itojun /*
765 1.2 itojun * Check for alternatives when higher level complains
766 1.2 itojun * about service problems. For now, invalidate cached
767 1.2 itojun * routing information. If the route was created dynamically
768 1.2 itojun * (by a redirect), time to try a default gateway again.
769 1.2 itojun */
770 1.2 itojun void
771 1.2 itojun in6_losing(in6p)
772 1.2 itojun struct in6pcb *in6p;
773 1.2 itojun {
774 1.2 itojun struct rtentry *rt;
775 1.2 itojun struct rt_addrinfo info;
776 1.2 itojun
777 1.56 itojun if (in6p->in6p_af != AF_INET6)
778 1.56 itojun return;
779 1.56 itojun
780 1.2 itojun if ((rt = in6p->in6p_route.ro_rt) != NULL) {
781 1.2 itojun in6p->in6p_route.ro_rt = 0;
782 1.2 itojun bzero((caddr_t)&info, sizeof(info));
783 1.2 itojun info.rti_info[RTAX_DST] =
784 1.2 itojun (struct sockaddr *)&in6p->in6p_route.ro_dst;
785 1.2 itojun info.rti_info[RTAX_GATEWAY] = rt->rt_gateway;
786 1.2 itojun info.rti_info[RTAX_NETMASK] = rt_mask(rt);
787 1.2 itojun rt_missmsg(RTM_LOSING, &info, rt->rt_flags, 0);
788 1.42 itojun if (rt->rt_flags & RTF_DYNAMIC) {
789 1.2 itojun (void)rtrequest(RTM_DELETE, rt_key(rt),
790 1.2 itojun rt->rt_gateway, rt_mask(rt), rt->rt_flags,
791 1.2 itojun (struct rtentry **)0);
792 1.42 itojun } else {
793 1.42 itojun /*
794 1.42 itojun * A new route can be allocated
795 1.42 itojun * the next time output is attempted.
796 1.42 itojun */
797 1.2 itojun rtfree(rt);
798 1.42 itojun }
799 1.2 itojun }
800 1.2 itojun }
801 1.2 itojun
802 1.2 itojun /*
803 1.2 itojun * After a routing change, flush old routing
804 1.2 itojun * and allocate a (hopefully) better one.
805 1.2 itojun */
806 1.2 itojun void
807 1.2 itojun in6_rtchange(in6p, errno)
808 1.2 itojun struct in6pcb *in6p;
809 1.2 itojun int errno;
810 1.2 itojun {
811 1.56 itojun if (in6p->in6p_af != AF_INET6)
812 1.56 itojun return;
813 1.56 itojun
814 1.2 itojun if (in6p->in6p_route.ro_rt) {
815 1.2 itojun rtfree(in6p->in6p_route.ro_rt);
816 1.2 itojun in6p->in6p_route.ro_rt = 0;
817 1.2 itojun /*
818 1.2 itojun * A new route can be allocated the next time
819 1.2 itojun * output is attempted.
820 1.2 itojun */
821 1.2 itojun }
822 1.2 itojun }
823 1.2 itojun
824 1.2 itojun struct in6pcb *
825 1.56 itojun in6_pcblookup_port(table, laddr6, lport_arg, lookup_wildcard)
826 1.56 itojun struct inpcbtable *table;
827 1.56 itojun struct in6_addr *laddr6;
828 1.56 itojun u_int lport_arg;
829 1.56 itojun int lookup_wildcard;
830 1.2 itojun {
831 1.60 itojun struct inpcbhead *head;
832 1.56 itojun struct inpcb_hdr *inph;
833 1.2 itojun struct in6pcb *in6p, *match = 0;
834 1.2 itojun int matchwild = 3, wildcard;
835 1.56 itojun u_int16_t lport = lport_arg;
836 1.56 itojun
837 1.60 itojun head = IN6PCBHASH_PORT(table, lport);
838 1.60 itojun LIST_FOREACH(inph, head, inph_lhash) {
839 1.56 itojun in6p = (struct in6pcb *)inph;
840 1.56 itojun if (in6p->in6p_af != AF_INET6)
841 1.56 itojun continue;
842 1.2 itojun
843 1.2 itojun if (in6p->in6p_lport != lport)
844 1.2 itojun continue;
845 1.2 itojun wildcard = 0;
846 1.56 itojun if (IN6_IS_ADDR_V4MAPPED(&in6p->in6p_faddr)) {
847 1.56 itojun if ((in6p->in6p_flags & IN6P_IPV6_V6ONLY) != 0)
848 1.2 itojun continue;
849 1.11 itojun }
850 1.56 itojun if (!IN6_IS_ADDR_UNSPECIFIED(&in6p->in6p_faddr))
851 1.56 itojun wildcard++;
852 1.56 itojun if (IN6_IS_ADDR_V4MAPPED(&in6p->in6p_laddr)) {
853 1.56 itojun if ((in6p->in6p_flags & IN6P_IPV6_V6ONLY) != 0)
854 1.56 itojun continue;
855 1.11 itojun if (!IN6_IS_ADDR_V4MAPPED(laddr6))
856 1.11 itojun continue;
857 1.56 itojun
858 1.56 itojun /* duplicate of IPv4 logic */
859 1.56 itojun wildcard = 0;
860 1.56 itojun if (IN6_IS_ADDR_V4MAPPED(&in6p->in6p_faddr) &&
861 1.56 itojun in6p->in6p_faddr.s6_addr32[3])
862 1.11 itojun wildcard++;
863 1.56 itojun if (!in6p->in6p_laddr.s6_addr32[3]) {
864 1.56 itojun if (laddr6->s6_addr32[3])
865 1.56 itojun wildcard++;
866 1.56 itojun } else {
867 1.56 itojun if (!laddr6->s6_addr32[3])
868 1.56 itojun wildcard++;
869 1.56 itojun else {
870 1.56 itojun if (in6p->in6p_laddr.s6_addr32[3] !=
871 1.56 itojun laddr6->s6_addr32[3])
872 1.56 itojun continue;
873 1.56 itojun }
874 1.56 itojun }
875 1.56 itojun } else if (IN6_IS_ADDR_UNSPECIFIED(&in6p->in6p_laddr)) {
876 1.11 itojun if (IN6_IS_ADDR_V4MAPPED(laddr6)) {
877 1.56 itojun if ((in6p->in6p_flags & IN6P_IPV6_V6ONLY) != 0)
878 1.11 itojun continue;
879 1.56 itojun }
880 1.56 itojun if (!IN6_IS_ADDR_UNSPECIFIED(laddr6))
881 1.2 itojun wildcard++;
882 1.56 itojun } else {
883 1.56 itojun if (IN6_IS_ADDR_V4MAPPED(laddr6)) {
884 1.56 itojun if ((in6p->in6p_flags & IN6P_IPV6_V6ONLY) != 0)
885 1.56 itojun continue;
886 1.56 itojun }
887 1.56 itojun if (IN6_IS_ADDR_UNSPECIFIED(laddr6))
888 1.2 itojun wildcard++;
889 1.56 itojun else {
890 1.56 itojun if (!IN6_ARE_ADDR_EQUAL(&in6p->in6p_laddr,
891 1.56 itojun laddr6))
892 1.11 itojun continue;
893 1.56 itojun }
894 1.2 itojun }
895 1.56 itojun if (wildcard && !lookup_wildcard)
896 1.2 itojun continue;
897 1.2 itojun if (wildcard < matchwild) {
898 1.2 itojun match = in6p;
899 1.2 itojun matchwild = wildcard;
900 1.2 itojun if (matchwild == 0)
901 1.2 itojun break;
902 1.2 itojun }
903 1.2 itojun }
904 1.52 itojun return (match);
905 1.2 itojun }
906 1.56 itojun #undef continue
907 1.2 itojun
908 1.55 itojun /*
909 1.55 itojun * WARNING: return value (rtentry) could be IPv4 one if in6pcb is connected to
910 1.55 itojun * IPv4 mapped address.
911 1.55 itojun */
912 1.2 itojun struct rtentry *
913 1.2 itojun in6_pcbrtentry(in6p)
914 1.2 itojun struct in6pcb *in6p;
915 1.2 itojun {
916 1.2 itojun struct route_in6 *ro;
917 1.34 itojun struct sockaddr_in6 *dst6;
918 1.2 itojun
919 1.2 itojun ro = &in6p->in6p_route;
920 1.34 itojun dst6 = (struct sockaddr_in6 *)&ro->ro_dst;
921 1.2 itojun
922 1.56 itojun if (in6p->in6p_af != AF_INET6)
923 1.56 itojun return (NULL);
924 1.56 itojun
925 1.48 itojun if (ro->ro_rt && ((ro->ro_rt->rt_flags & RTF_UP) == 0 ||
926 1.48 itojun !IN6_ARE_ADDR_EQUAL(&dst6->sin6_addr, &in6p->in6p_faddr))) {
927 1.48 itojun RTFREE(ro->ro_rt);
928 1.48 itojun ro->ro_rt = (struct rtentry *)NULL;
929 1.48 itojun }
930 1.55 itojun #ifdef INET
931 1.55 itojun if (ro->ro_rt == (struct rtentry *)NULL &&
932 1.55 itojun IN6_IS_ADDR_V4MAPPED(&in6p->in6p_faddr)) {
933 1.55 itojun struct sockaddr_in *dst = (struct sockaddr_in *)&ro->ro_dst;
934 1.55 itojun
935 1.55 itojun bzero(dst, sizeof(*dst));
936 1.55 itojun dst->sin_family = AF_INET;
937 1.55 itojun dst->sin_len = sizeof(struct sockaddr_in);
938 1.55 itojun bcopy(&in6p->in6p_faddr.s6_addr32[3], &dst->sin_addr,
939 1.55 itojun sizeof(dst->sin_addr));
940 1.55 itojun rtalloc((struct route *)ro);
941 1.55 itojun } else
942 1.55 itojun #endif
943 1.48 itojun if (ro->ro_rt == (struct rtentry *)NULL &&
944 1.48 itojun !IN6_IS_ADDR_UNSPECIFIED(&in6p->in6p_faddr)) {
945 1.48 itojun bzero(dst6, sizeof(*dst6));
946 1.48 itojun dst6->sin6_family = AF_INET6;
947 1.48 itojun dst6->sin6_len = sizeof(struct sockaddr_in6);
948 1.48 itojun dst6->sin6_addr = in6p->in6p_faddr;
949 1.48 itojun rtalloc((struct route *)ro);
950 1.2 itojun }
951 1.2 itojun return (ro->ro_rt);
952 1.2 itojun }
953 1.2 itojun
954 1.2 itojun struct in6pcb *
955 1.56 itojun in6_pcblookup_connect(table, faddr6, fport_arg, laddr6, lport_arg, faith)
956 1.56 itojun struct inpcbtable *table;
957 1.2 itojun struct in6_addr *faddr6, *laddr6;
958 1.2 itojun u_int fport_arg, lport_arg;
959 1.8 itojun int faith;
960 1.2 itojun {
961 1.56 itojun struct inpcbhead *head;
962 1.56 itojun struct inpcb_hdr *inph;
963 1.2 itojun struct in6pcb *in6p;
964 1.18 itojun u_int16_t fport = fport_arg, lport = lport_arg;
965 1.2 itojun
966 1.56 itojun head = IN6PCBHASH_CONNECT(table, faddr6, fport, laddr6, lport);
967 1.56 itojun LIST_FOREACH(inph, head, inph_hash) {
968 1.56 itojun in6p = (struct in6pcb *)inph;
969 1.56 itojun if (in6p->in6p_af != AF_INET6)
970 1.56 itojun continue;
971 1.56 itojun
972 1.2 itojun /* find exact match on both source and dest */
973 1.2 itojun if (in6p->in6p_fport != fport)
974 1.2 itojun continue;
975 1.2 itojun if (in6p->in6p_lport != lport)
976 1.2 itojun continue;
977 1.2 itojun if (IN6_IS_ADDR_UNSPECIFIED(&in6p->in6p_faddr))
978 1.2 itojun continue;
979 1.2 itojun if (!IN6_ARE_ADDR_EQUAL(&in6p->in6p_faddr, faddr6))
980 1.2 itojun continue;
981 1.2 itojun if (IN6_IS_ADDR_UNSPECIFIED(&in6p->in6p_laddr))
982 1.2 itojun continue;
983 1.2 itojun if (!IN6_ARE_ADDR_EQUAL(&in6p->in6p_laddr, laddr6))
984 1.2 itojun continue;
985 1.41 itojun if ((IN6_IS_ADDR_V4MAPPED(laddr6) ||
986 1.41 itojun IN6_IS_ADDR_V4MAPPED(faddr6)) &&
987 1.41 itojun (in6p->in6p_flags & IN6P_IPV6_V6ONLY))
988 1.41 itojun continue;
989 1.2 itojun return in6p;
990 1.2 itojun }
991 1.2 itojun return NULL;
992 1.2 itojun }
993 1.2 itojun
994 1.2 itojun struct in6pcb *
995 1.56 itojun in6_pcblookup_bind(table, laddr6, lport_arg, faith)
996 1.56 itojun struct inpcbtable *table;
997 1.2 itojun struct in6_addr *laddr6;
998 1.2 itojun u_int lport_arg;
999 1.8 itojun int faith;
1000 1.2 itojun {
1001 1.56 itojun struct inpcbhead *head;
1002 1.56 itojun struct inpcb_hdr *inph;
1003 1.56 itojun struct in6pcb *in6p;
1004 1.18 itojun u_int16_t lport = lport_arg;
1005 1.62 atatat #ifdef INET
1006 1.56 itojun struct in6_addr zero_mapped;
1007 1.56 itojun #endif
1008 1.56 itojun
1009 1.56 itojun head = IN6PCBHASH_BIND(table, laddr6, lport);
1010 1.56 itojun LIST_FOREACH(inph, head, inph_hash) {
1011 1.56 itojun in6p = (struct in6pcb *)inph;
1012 1.56 itojun if (in6p->in6p_af != AF_INET6)
1013 1.56 itojun continue;
1014 1.2 itojun
1015 1.8 itojun if (faith && (in6p->in6p_flags & IN6P_FAITH) == 0)
1016 1.8 itojun continue;
1017 1.2 itojun if (in6p->in6p_fport != 0)
1018 1.2 itojun continue;
1019 1.2 itojun if (in6p->in6p_lport != lport)
1020 1.2 itojun continue;
1021 1.56 itojun if (IN6_IS_ADDR_V4MAPPED(laddr6) &&
1022 1.56 itojun (in6p->in6p_flags & IN6P_IPV6_V6ONLY) != 0)
1023 1.56 itojun continue;
1024 1.56 itojun if (IN6_ARE_ADDR_EQUAL(&in6p->in6p_laddr, laddr6))
1025 1.56 itojun goto out;
1026 1.56 itojun }
1027 1.56 itojun #ifdef INET
1028 1.56 itojun if (IN6_IS_ADDR_V4MAPPED(laddr6)) {
1029 1.56 itojun memset(&zero_mapped, 0, sizeof(zero_mapped));
1030 1.56 itojun zero_mapped.s6_addr16[5] = 0xffff;
1031 1.56 itojun head = IN6PCBHASH_BIND(table, &zero_mapped, lport);
1032 1.56 itojun LIST_FOREACH(inph, head, inph_hash) {
1033 1.56 itojun in6p = (struct in6pcb *)inph;
1034 1.56 itojun if (in6p->in6p_af != AF_INET6)
1035 1.56 itojun continue;
1036 1.56 itojun
1037 1.56 itojun if (faith && (in6p->in6p_flags & IN6P_FAITH) == 0)
1038 1.56 itojun continue;
1039 1.56 itojun if (in6p->in6p_fport != 0)
1040 1.56 itojun continue;
1041 1.56 itojun if (in6p->in6p_lport != lport)
1042 1.56 itojun continue;
1043 1.56 itojun if ((in6p->in6p_flags & IN6P_IPV6_V6ONLY) != 0)
1044 1.56 itojun continue;
1045 1.56 itojun if (IN6_ARE_ADDR_EQUAL(&in6p->in6p_laddr, &zero_mapped))
1046 1.56 itojun goto out;
1047 1.11 itojun }
1048 1.2 itojun }
1049 1.56 itojun #endif
1050 1.56 itojun head = IN6PCBHASH_BIND(table, &zeroin6_addr, lport);
1051 1.56 itojun LIST_FOREACH(inph, head, inph_hash) {
1052 1.56 itojun in6p = (struct in6pcb *)inph;
1053 1.56 itojun if (in6p->in6p_af != AF_INET6)
1054 1.56 itojun continue;
1055 1.56 itojun
1056 1.56 itojun if (faith && (in6p->in6p_flags & IN6P_FAITH) == 0)
1057 1.56 itojun continue;
1058 1.56 itojun if (in6p->in6p_fport != 0)
1059 1.56 itojun continue;
1060 1.56 itojun if (in6p->in6p_lport != lport)
1061 1.56 itojun continue;
1062 1.56 itojun if (IN6_IS_ADDR_V4MAPPED(laddr6) &&
1063 1.56 itojun (in6p->in6p_flags & IN6P_IPV6_V6ONLY) != 0)
1064 1.56 itojun continue;
1065 1.56 itojun if (IN6_ARE_ADDR_EQUAL(&in6p->in6p_laddr, &zeroin6_addr))
1066 1.56 itojun goto out;
1067 1.56 itojun }
1068 1.56 itojun return (NULL);
1069 1.56 itojun
1070 1.56 itojun out:
1071 1.56 itojun inph = &in6p->in6p_head;
1072 1.56 itojun if (inph != LIST_FIRST(head)) {
1073 1.56 itojun LIST_REMOVE(inph, inph_hash);
1074 1.56 itojun LIST_INSERT_HEAD(head, inph, inph_hash);
1075 1.56 itojun }
1076 1.56 itojun return in6p;
1077 1.56 itojun }
1078 1.56 itojun
1079 1.56 itojun void
1080 1.56 itojun in6_pcbstate(in6p, state)
1081 1.56 itojun struct in6pcb *in6p;
1082 1.56 itojun int state;
1083 1.56 itojun {
1084 1.56 itojun
1085 1.56 itojun if (in6p->in6p_af != AF_INET6)
1086 1.56 itojun return;
1087 1.56 itojun
1088 1.56 itojun if (in6p->in6p_state > IN6P_ATTACHED)
1089 1.56 itojun LIST_REMOVE(&in6p->in6p_head, inph_hash);
1090 1.56 itojun
1091 1.56 itojun switch (state) {
1092 1.56 itojun case IN6P_BOUND:
1093 1.56 itojun LIST_INSERT_HEAD(IN6PCBHASH_BIND(in6p->in6p_table,
1094 1.56 itojun &in6p->in6p_laddr, in6p->in6p_lport), &in6p->in6p_head,
1095 1.56 itojun inph_hash);
1096 1.56 itojun break;
1097 1.56 itojun case IN6P_CONNECTED:
1098 1.56 itojun LIST_INSERT_HEAD(IN6PCBHASH_CONNECT(in6p->in6p_table,
1099 1.56 itojun &in6p->in6p_faddr, in6p->in6p_fport,
1100 1.56 itojun &in6p->in6p_laddr, in6p->in6p_lport), &in6p->in6p_head,
1101 1.56 itojun inph_hash);
1102 1.56 itojun break;
1103 1.56 itojun }
1104 1.56 itojun
1105 1.56 itojun in6p->in6p_state = state;
1106 1.2 itojun }
1107