xref: /freebsd/sys/netinet6/in6_pcb.c (revision f31f65a7084e664ef6e3c92bcaebab5af0d9ece9)
1686cdd19SJun-ichiro itojun Hagino /*	$FreeBSD$	*/
233841545SHajimu UMEMOTO /*	$KAME: in6_pcb.c,v 1.31 2001/05/21 05:45:10 jinmei Exp $	*/
3686cdd19SJun-ichiro itojun Hagino 
482cd038dSYoshinobu Inoue /*
582cd038dSYoshinobu Inoue  * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project.
682cd038dSYoshinobu Inoue  * All rights reserved.
782cd038dSYoshinobu Inoue  *
882cd038dSYoshinobu Inoue  * Redistribution and use in source and binary forms, with or without
982cd038dSYoshinobu Inoue  * modification, are permitted provided that the following conditions
1082cd038dSYoshinobu Inoue  * are met:
1182cd038dSYoshinobu Inoue  * 1. Redistributions of source code must retain the above copyright
1282cd038dSYoshinobu Inoue  *    notice, this list of conditions and the following disclaimer.
1382cd038dSYoshinobu Inoue  * 2. Redistributions in binary form must reproduce the above copyright
1482cd038dSYoshinobu Inoue  *    notice, this list of conditions and the following disclaimer in the
1582cd038dSYoshinobu Inoue  *    documentation and/or other materials provided with the distribution.
1682cd038dSYoshinobu Inoue  * 3. Neither the name of the project nor the names of its contributors
1782cd038dSYoshinobu Inoue  *    may be used to endorse or promote products derived from this software
1882cd038dSYoshinobu Inoue  *    without specific prior written permission.
1982cd038dSYoshinobu Inoue  *
2082cd038dSYoshinobu Inoue  * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
2182cd038dSYoshinobu Inoue  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
2282cd038dSYoshinobu Inoue  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
2382cd038dSYoshinobu Inoue  * ARE DISCLAIMED.  IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
2482cd038dSYoshinobu Inoue  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
2582cd038dSYoshinobu Inoue  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
2682cd038dSYoshinobu Inoue  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
2782cd038dSYoshinobu Inoue  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
2882cd038dSYoshinobu Inoue  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
2982cd038dSYoshinobu Inoue  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
3082cd038dSYoshinobu Inoue  * SUCH DAMAGE.
3182cd038dSYoshinobu Inoue  *
3282cd038dSYoshinobu Inoue  */
3382cd038dSYoshinobu Inoue 
3482cd038dSYoshinobu Inoue /*
3582cd038dSYoshinobu Inoue  * Copyright (c) 1982, 1986, 1991, 1993
3682cd038dSYoshinobu Inoue  *	The Regents of the University of California.  All rights reserved.
3782cd038dSYoshinobu Inoue  *
3882cd038dSYoshinobu Inoue  * Redistribution and use in source and binary forms, with or without
3982cd038dSYoshinobu Inoue  * modification, are permitted provided that the following conditions
4082cd038dSYoshinobu Inoue  * are met:
4182cd038dSYoshinobu Inoue  * 1. Redistributions of source code must retain the above copyright
4282cd038dSYoshinobu Inoue  *    notice, this list of conditions and the following disclaimer.
4382cd038dSYoshinobu Inoue  * 2. Redistributions in binary form must reproduce the above copyright
4482cd038dSYoshinobu Inoue  *    notice, this list of conditions and the following disclaimer in the
4582cd038dSYoshinobu Inoue  *    documentation and/or other materials provided with the distribution.
4682cd038dSYoshinobu Inoue  * 4. Neither the name of the University nor the names of its contributors
4782cd038dSYoshinobu Inoue  *    may be used to endorse or promote products derived from this software
4882cd038dSYoshinobu Inoue  *    without specific prior written permission.
4982cd038dSYoshinobu Inoue  *
5082cd038dSYoshinobu Inoue  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
5182cd038dSYoshinobu Inoue  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
5282cd038dSYoshinobu Inoue  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
5382cd038dSYoshinobu Inoue  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
5482cd038dSYoshinobu Inoue  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
5582cd038dSYoshinobu Inoue  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
5682cd038dSYoshinobu Inoue  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
5782cd038dSYoshinobu Inoue  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
5882cd038dSYoshinobu Inoue  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
5982cd038dSYoshinobu Inoue  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
6082cd038dSYoshinobu Inoue  * SUCH DAMAGE.
6182cd038dSYoshinobu Inoue  *
6282cd038dSYoshinobu Inoue  *	@(#)in_pcb.c	8.2 (Berkeley) 1/4/94
6382cd038dSYoshinobu Inoue  */
6482cd038dSYoshinobu Inoue 
6533841545SHajimu UMEMOTO #include "opt_inet.h"
6633841545SHajimu UMEMOTO #include "opt_inet6.h"
676a800098SYoshinobu Inoue #include "opt_ipsec.h"
68b79274baSHajimu UMEMOTO #include "opt_random_ip_id.h"
6982cd038dSYoshinobu Inoue 
7082cd038dSYoshinobu Inoue #include <sys/param.h>
7182cd038dSYoshinobu Inoue #include <sys/systm.h>
7282cd038dSYoshinobu Inoue #include <sys/malloc.h>
7382cd038dSYoshinobu Inoue #include <sys/mbuf.h>
74fb59c426SYoshinobu Inoue #include <sys/domain.h>
7582cd038dSYoshinobu Inoue #include <sys/protosw.h>
7682cd038dSYoshinobu Inoue #include <sys/socket.h>
7782cd038dSYoshinobu Inoue #include <sys/socketvar.h>
7882cd038dSYoshinobu Inoue #include <sys/sockio.h>
7982cd038dSYoshinobu Inoue #include <sys/errno.h>
8082cd038dSYoshinobu Inoue #include <sys/time.h>
8182cd038dSYoshinobu Inoue #include <sys/proc.h>
8282cd038dSYoshinobu Inoue #include <sys/jail.h>
8382cd038dSYoshinobu Inoue 
8494540027SJeff Roberson #include <vm/uma.h>
8582cd038dSYoshinobu Inoue 
8682cd038dSYoshinobu Inoue #include <net/if.h>
8782cd038dSYoshinobu Inoue #include <net/if_types.h>
8882cd038dSYoshinobu Inoue #include <net/route.h>
8982cd038dSYoshinobu Inoue 
9082cd038dSYoshinobu Inoue #include <netinet/in.h>
9182cd038dSYoshinobu Inoue #include <netinet/in_var.h>
9282cd038dSYoshinobu Inoue #include <netinet/in_systm.h>
93f76fcf6dSJeffrey Hsu #include <netinet/tcp_var.h>
94686cdd19SJun-ichiro itojun Hagino #include <netinet/ip6.h>
95fb59c426SYoshinobu Inoue #include <netinet/ip_var.h>
9682cd038dSYoshinobu Inoue #include <netinet6/ip6_var.h>
9782cd038dSYoshinobu Inoue #include <netinet6/nd6.h>
9882cd038dSYoshinobu Inoue #include <netinet/in_pcb.h>
9982cd038dSYoshinobu Inoue #include <netinet6/in6_pcb.h>
10082cd038dSYoshinobu Inoue 
10182cd038dSYoshinobu Inoue #ifdef IPSEC
10282cd038dSYoshinobu Inoue #include <netinet6/ipsec.h>
10333841545SHajimu UMEMOTO #ifdef INET6
10482cd038dSYoshinobu Inoue #include <netinet6/ipsec6.h>
10533841545SHajimu UMEMOTO #endif
10633841545SHajimu UMEMOTO #include <netinet6/ah.h>
10733841545SHajimu UMEMOTO #ifdef INET6
1086a800098SYoshinobu Inoue #include <netinet6/ah6.h>
10933841545SHajimu UMEMOTO #endif
11082cd038dSYoshinobu Inoue #include <netkey/key.h>
11182cd038dSYoshinobu Inoue #endif /* IPSEC */
11282cd038dSYoshinobu Inoue 
113b9234fafSSam Leffler #ifdef FAST_IPSEC
114b9234fafSSam Leffler #include <netipsec/ipsec.h>
115b9234fafSSam Leffler #include <netipsec/ipsec6.h>
116b9234fafSSam Leffler #include <netipsec/key.h>
117b9234fafSSam Leffler #endif /* FAST_IPSEC */
118b9234fafSSam Leffler 
11982cd038dSYoshinobu Inoue struct	in6_addr zeroin6_addr;
12082cd038dSYoshinobu Inoue 
12182cd038dSYoshinobu Inoue int
122b0330ed9SPawel Jakub Dawidek in6_pcbbind(inp, nam, cred)
12382cd038dSYoshinobu Inoue 	register struct inpcb *inp;
12482cd038dSYoshinobu Inoue 	struct sockaddr *nam;
125b0330ed9SPawel Jakub Dawidek 	struct ucred *cred;
12682cd038dSYoshinobu Inoue {
12782cd038dSYoshinobu Inoue 	struct socket *so = inp->inp_socket;
12882cd038dSYoshinobu Inoue 	struct sockaddr_in6 *sin6 = (struct sockaddr_in6 *)NULL;
12982cd038dSYoshinobu Inoue 	struct inpcbinfo *pcbinfo = inp->inp_pcbinfo;
13082cd038dSYoshinobu Inoue 	u_short	lport = 0;
1314cc20ab1SSeigo Tanimura 	int wild = 0, reuseport = (so->so_options & SO_REUSEPORT);
13282cd038dSYoshinobu Inoue 
13307385abdSRobert Watson 	INP_INFO_WLOCK_ASSERT(pcbinfo);
13407385abdSRobert Watson 	INP_LOCK_ASSERT(inp);
13507385abdSRobert Watson 
13682cd038dSYoshinobu Inoue 	if (!in6_ifaddr) /* XXX broken! */
13782cd038dSYoshinobu Inoue 		return (EADDRNOTAVAIL);
13882cd038dSYoshinobu Inoue 	if (inp->inp_lport || !IN6_IS_ADDR_UNSPECIFIED(&inp->in6p_laddr))
13982cd038dSYoshinobu Inoue 		return (EINVAL);
14082cd038dSYoshinobu Inoue 	if ((so->so_options & (SO_REUSEADDR|SO_REUSEPORT)) == 0)
14182cd038dSYoshinobu Inoue 		wild = 1;
14282cd038dSYoshinobu Inoue 	if (nam) {
14382cd038dSYoshinobu Inoue 		sin6 = (struct sockaddr_in6 *)nam;
14482cd038dSYoshinobu Inoue 		if (nam->sa_len != sizeof(*sin6))
14582cd038dSYoshinobu Inoue 			return (EINVAL);
14682cd038dSYoshinobu Inoue 		/*
14782cd038dSYoshinobu Inoue 		 * family check.
14882cd038dSYoshinobu Inoue 		 */
14982cd038dSYoshinobu Inoue 		if (nam->sa_family != AF_INET6)
15082cd038dSYoshinobu Inoue 			return (EAFNOSUPPORT);
15182cd038dSYoshinobu Inoue 
152686cdd19SJun-ichiro itojun Hagino 		/* KAME hack: embed scopeid */
153686cdd19SJun-ichiro itojun Hagino 		if (in6_embedscope(&sin6->sin6_addr, sin6, inp, NULL) != 0)
154686cdd19SJun-ichiro itojun Hagino 			return EINVAL;
15582cd038dSYoshinobu Inoue 		/* this must be cleared for ifa_ifwithaddr() */
15682cd038dSYoshinobu Inoue 		sin6->sin6_scope_id = 0;
15782cd038dSYoshinobu Inoue 
15882cd038dSYoshinobu Inoue 		lport = sin6->sin6_port;
15982cd038dSYoshinobu Inoue 		if (IN6_IS_ADDR_MULTICAST(&sin6->sin6_addr)) {
16082cd038dSYoshinobu Inoue 			/*
16182cd038dSYoshinobu Inoue 			 * Treat SO_REUSEADDR as SO_REUSEPORT for multicast;
16282cd038dSYoshinobu Inoue 			 * allow compepte duplication of binding if
16382cd038dSYoshinobu Inoue 			 * SO_REUSEPORT is set, or if SO_REUSEADDR is set
16482cd038dSYoshinobu Inoue 			 * and a multicast address is bound on both
16582cd038dSYoshinobu Inoue 			 * new and duplicated sockets.
16682cd038dSYoshinobu Inoue 			 */
16782cd038dSYoshinobu Inoue 			if (so->so_options & SO_REUSEADDR)
16882cd038dSYoshinobu Inoue 				reuseport = SO_REUSEADDR|SO_REUSEPORT;
16982cd038dSYoshinobu Inoue 		} else if (!IN6_IS_ADDR_UNSPECIFIED(&sin6->sin6_addr)) {
17082cd038dSYoshinobu Inoue 			struct ifaddr *ia = NULL;
17182cd038dSYoshinobu Inoue 
17282cd038dSYoshinobu Inoue 			sin6->sin6_port = 0;		/* yech... */
17382cd038dSYoshinobu Inoue 			if ((ia = ifa_ifwithaddr((struct sockaddr *)sin6)) == 0)
17482cd038dSYoshinobu Inoue 				return (EADDRNOTAVAIL);
17582cd038dSYoshinobu Inoue 
17682cd038dSYoshinobu Inoue 			/*
17782cd038dSYoshinobu Inoue 			 * XXX: bind to an anycast address might accidentally
17882cd038dSYoshinobu Inoue 			 * cause sending a packet with anycast source address.
17933841545SHajimu UMEMOTO 			 * We should allow to bind to a deprecated address, since
1807efe5d92SHajimu UMEMOTO 			 * the application dares to use it.
18182cd038dSYoshinobu Inoue 			 */
18282cd038dSYoshinobu Inoue 			if (ia &&
18382cd038dSYoshinobu Inoue 			    ((struct in6_ifaddr *)ia)->ia6_flags &
18433841545SHajimu UMEMOTO 			    (IN6_IFF_ANYCAST|IN6_IFF_NOTREADY|IN6_IFF_DETACHED)) {
18582cd038dSYoshinobu Inoue 				return (EADDRNOTAVAIL);
18682cd038dSYoshinobu Inoue 			}
18782cd038dSYoshinobu Inoue 		}
18882cd038dSYoshinobu Inoue 		if (lport) {
18982cd038dSYoshinobu Inoue 			struct inpcb *t;
19082cd038dSYoshinobu Inoue 
19182cd038dSYoshinobu Inoue 			/* GROSS */
192b0330ed9SPawel Jakub Dawidek 			if (ntohs(lport) < IPV6PORT_RESERVED &&
19356f21b9dSColin Percival 			    suser_cred(cred, SUSER_ALLOWJAIL))
19482cd038dSYoshinobu Inoue 				return (EACCES);
19582cd038dSYoshinobu Inoue 			if (so->so_cred->cr_uid != 0 &&
19682cd038dSYoshinobu Inoue 			    !IN6_IS_ADDR_MULTICAST(&sin6->sin6_addr)) {
197fb59c426SYoshinobu Inoue 				t = in6_pcblookup_local(pcbinfo,
19882cd038dSYoshinobu Inoue 				    &sin6->sin6_addr, lport,
19982cd038dSYoshinobu Inoue 				    INPLOOKUP_WILDCARD);
200f66145c6SYaroslav Tykhiy 				if (t &&
201f66145c6SYaroslav Tykhiy 				    ((t->inp_vflag & INP_TIMEWAIT) == 0) &&
202f66145c6SYaroslav Tykhiy 				    (so->so_type != SOCK_STREAM ||
203f66145c6SYaroslav Tykhiy 				     IN6_IS_ADDR_UNSPECIFIED(&t->in6p_faddr)) &&
2044cc20ab1SSeigo Tanimura 				    (!IN6_IS_ADDR_UNSPECIFIED(&sin6->sin6_addr) ||
20582cd038dSYoshinobu Inoue 			    	     !IN6_IS_ADDR_UNSPECIFIED(&t->in6p_laddr) ||
20656e6821eSOlivier Houchard 				     (t->inp_socket->so_options & SO_REUSEPORT)
20756e6821eSOlivier Houchard 				      == 0) && (so->so_cred->cr_uid !=
2084cc20ab1SSeigo Tanimura 				     t->inp_socket->so_cred->cr_uid))
20982cd038dSYoshinobu Inoue 					return (EADDRINUSE);
21033841545SHajimu UMEMOTO 				if ((inp->inp_flags & IN6P_IPV6_V6ONLY) == 0 &&
211fb59c426SYoshinobu Inoue 				    IN6_IS_ADDR_UNSPECIFIED(&sin6->sin6_addr)) {
212fb59c426SYoshinobu Inoue 					struct sockaddr_in sin;
213fb59c426SYoshinobu Inoue 
214fb59c426SYoshinobu Inoue 					in6_sin6_2_sin(&sin, sin6);
215fb59c426SYoshinobu Inoue 					t = in_pcblookup_local(pcbinfo,
216fb59c426SYoshinobu Inoue 						sin.sin_addr, lport,
217fb59c426SYoshinobu Inoue 						INPLOOKUP_WILDCARD);
218f66145c6SYaroslav Tykhiy 					if (t &&
219f66145c6SYaroslav Tykhiy 					    ((t->inp_vflag &
220f66145c6SYaroslav Tykhiy 					      INP_TIMEWAIT) == 0) &&
221f66145c6SYaroslav Tykhiy 					    (so->so_type != SOCK_STREAM ||
222f66145c6SYaroslav Tykhiy 					     ntohl(t->inp_faddr.s_addr) ==
223f66145c6SYaroslav Tykhiy 					      INADDR_ANY) &&
224fb59c426SYoshinobu Inoue 					    (so->so_cred->cr_uid !=
225a4eb4405SYaroslav Tykhiy 					     t->inp_socket->so_cred->cr_uid))
226fb59c426SYoshinobu Inoue 						return (EADDRINUSE);
227fb59c426SYoshinobu Inoue 				}
22882cd038dSYoshinobu Inoue 			}
22982cd038dSYoshinobu Inoue 			t = in6_pcblookup_local(pcbinfo, &sin6->sin6_addr,
23082cd038dSYoshinobu Inoue 						lport, wild);
23156e6821eSOlivier Houchard 			if (t && (reuseport & ((t->inp_vflag & INP_TIMEWAIT) ?
23256e6821eSOlivier Houchard 			    intotw(t)->tw_so_options :
23356e6821eSOlivier Houchard 			    t->inp_socket->so_options)) == 0)
23482cd038dSYoshinobu Inoue 				return (EADDRINUSE);
23533841545SHajimu UMEMOTO 			if ((inp->inp_flags & IN6P_IPV6_V6ONLY) == 0 &&
236fb59c426SYoshinobu Inoue 			    IN6_IS_ADDR_UNSPECIFIED(&sin6->sin6_addr)) {
237fb59c426SYoshinobu Inoue 				struct sockaddr_in sin;
238fb59c426SYoshinobu Inoue 
239fb59c426SYoshinobu Inoue 				in6_sin6_2_sin(&sin, sin6);
240fb59c426SYoshinobu Inoue 				t = in_pcblookup_local(pcbinfo, sin.sin_addr,
241fb59c426SYoshinobu Inoue 						       lport, wild);
24256e6821eSOlivier Houchard 				if (t && t->inp_vflag & INP_TIMEWAIT) {
24356e6821eSOlivier Houchard 					if ((reuseport &
24456e6821eSOlivier Houchard 					    intotw(t)->tw_so_options) == 0 &&
24556e6821eSOlivier Houchard 					    (ntohl(t->inp_laddr.s_addr) !=
24656e6821eSOlivier Houchard 					     INADDR_ANY || ((inp->inp_vflag &
24756e6821eSOlivier Houchard 					     INP_IPV6PROTO) ==
24856e6821eSOlivier Houchard 					     (t->inp_vflag & INP_IPV6PROTO))))
24956e6821eSOlivier Houchard 						return (EADDRINUSE);
25056e6821eSOlivier Houchard 				}
25156e6821eSOlivier Houchard 				else if (t &&
2524cc20ab1SSeigo Tanimura 				    (reuseport & t->inp_socket->so_options)
25356e6821eSOlivier Houchard 				    == 0 && (ntohl(t->inp_laddr.s_addr) !=
25456e6821eSOlivier Houchard 				    INADDR_ANY || INP_SOCKAF(so) ==
2554cc20ab1SSeigo Tanimura 				     INP_SOCKAF(t->inp_socket)))
256fb59c426SYoshinobu Inoue 					return (EADDRINUSE);
257fb59c426SYoshinobu Inoue 			}
25882cd038dSYoshinobu Inoue 		}
25982cd038dSYoshinobu Inoue 		inp->in6p_laddr = sin6->sin6_addr;
26082cd038dSYoshinobu Inoue 	}
26182cd038dSYoshinobu Inoue 	if (lport == 0) {
262686cdd19SJun-ichiro itojun Hagino 		int e;
263b0330ed9SPawel Jakub Dawidek 		if ((e = in6_pcbsetport(&inp->in6p_laddr, inp, cred)) != 0)
264686cdd19SJun-ichiro itojun Hagino 			return (e);
26582cd038dSYoshinobu Inoue 	}
266686cdd19SJun-ichiro itojun Hagino 	else {
26782cd038dSYoshinobu Inoue 		inp->inp_lport = lport;
26882cd038dSYoshinobu Inoue 		if (in_pcbinshash(inp) != 0) {
26982cd038dSYoshinobu Inoue 			inp->in6p_laddr = in6addr_any;
27082cd038dSYoshinobu Inoue 			inp->inp_lport = 0;
27182cd038dSYoshinobu Inoue 			return (EAGAIN);
27282cd038dSYoshinobu Inoue 		}
273686cdd19SJun-ichiro itojun Hagino 	}
27482cd038dSYoshinobu Inoue 	return (0);
27582cd038dSYoshinobu Inoue }
27682cd038dSYoshinobu Inoue 
27782cd038dSYoshinobu Inoue /*
27882cd038dSYoshinobu Inoue  *   Transform old in6_pcbconnect() into an inner subroutine for new
27982cd038dSYoshinobu Inoue  *   in6_pcbconnect(): Do some validity-checking on the remote
28082cd038dSYoshinobu Inoue  *   address (in mbuf 'nam') and then determine local host address
28182cd038dSYoshinobu Inoue  *   (i.e., which interface) to use to access that remote host.
28282cd038dSYoshinobu Inoue  *
28382cd038dSYoshinobu Inoue  *   This preserves definition of in6_pcbconnect(), while supporting a
28482cd038dSYoshinobu Inoue  *   slightly different version for T/TCP.  (This is more than
28582cd038dSYoshinobu Inoue  *   a bit of a kludge, but cleaning up the internal interfaces would
28682cd038dSYoshinobu Inoue  *   have forced minor changes in every protocol).
28782cd038dSYoshinobu Inoue  */
28882cd038dSYoshinobu Inoue 
28982cd038dSYoshinobu Inoue int
29082cd038dSYoshinobu Inoue in6_pcbladdr(inp, nam, plocal_addr6)
29182cd038dSYoshinobu Inoue 	register struct inpcb *inp;
29282cd038dSYoshinobu Inoue 	struct sockaddr *nam;
29382cd038dSYoshinobu Inoue 	struct in6_addr **plocal_addr6;
29482cd038dSYoshinobu Inoue {
29582cd038dSYoshinobu Inoue 	register struct sockaddr_in6 *sin6 = (struct sockaddr_in6 *)nam;
29682cd038dSYoshinobu Inoue 	struct ifnet *ifp = NULL;
29782cd038dSYoshinobu Inoue 	int error = 0;
29882cd038dSYoshinobu Inoue 
29982cd038dSYoshinobu Inoue 	if (nam->sa_len != sizeof (*sin6))
30082cd038dSYoshinobu Inoue 		return (EINVAL);
30182cd038dSYoshinobu Inoue 	if (sin6->sin6_family != AF_INET6)
30282cd038dSYoshinobu Inoue 		return (EAFNOSUPPORT);
30382cd038dSYoshinobu Inoue 	if (sin6->sin6_port == 0)
30482cd038dSYoshinobu Inoue 		return (EADDRNOTAVAIL);
30582cd038dSYoshinobu Inoue 
30607385abdSRobert Watson 	INP_INFO_WLOCK_ASSERT(inp->inp_pcbinfo);
30707385abdSRobert Watson 	INP_LOCK_ASSERT(inp);
30807385abdSRobert Watson 
309686cdd19SJun-ichiro itojun Hagino 	/* KAME hack: embed scopeid */
310686cdd19SJun-ichiro itojun Hagino 	if (in6_embedscope(&sin6->sin6_addr, sin6, inp, &ifp) != 0)
311686cdd19SJun-ichiro itojun Hagino 		return EINVAL;
31282cd038dSYoshinobu Inoue 
31382cd038dSYoshinobu Inoue 	if (in6_ifaddr) {
31482cd038dSYoshinobu Inoue 		/*
31582cd038dSYoshinobu Inoue 		 * If the destination address is UNSPECIFIED addr,
31682cd038dSYoshinobu Inoue 		 * use the loopback addr, e.g ::1.
31782cd038dSYoshinobu Inoue 		 */
31882cd038dSYoshinobu Inoue 		if (IN6_IS_ADDR_UNSPECIFIED(&sin6->sin6_addr))
31982cd038dSYoshinobu Inoue 			sin6->sin6_addr = in6addr_loopback;
32082cd038dSYoshinobu Inoue 	}
32182cd038dSYoshinobu Inoue 	{
32282cd038dSYoshinobu Inoue 		/*
32382cd038dSYoshinobu Inoue 		 * XXX: in6_selectsrc might replace the bound local address
32482cd038dSYoshinobu Inoue 		 * with the address specified by setsockopt(IPV6_PKTINFO).
32582cd038dSYoshinobu Inoue 		 * Is it the intended behavior?
32682cd038dSYoshinobu Inoue 		 */
32782cd038dSYoshinobu Inoue 		*plocal_addr6 = in6_selectsrc(sin6, inp->in6p_outputopts,
32897d8d152SAndre Oppermann 					      inp->in6p_moptions, NULL,
32982cd038dSYoshinobu Inoue 					      &inp->in6p_laddr, &error);
33082cd038dSYoshinobu Inoue 		if (*plocal_addr6 == 0) {
33182cd038dSYoshinobu Inoue 			if (error == 0)
33282cd038dSYoshinobu Inoue 				error = EADDRNOTAVAIL;
33382cd038dSYoshinobu Inoue 			return (error);
33482cd038dSYoshinobu Inoue 		}
33582cd038dSYoshinobu Inoue 		/*
33682cd038dSYoshinobu Inoue 		 * Don't do pcblookup call here; return interface in
33782cd038dSYoshinobu Inoue 		 * plocal_addr6
33882cd038dSYoshinobu Inoue 		 * and exit to caller, that will do the lookup.
33982cd038dSYoshinobu Inoue 		 */
34082cd038dSYoshinobu Inoue 	}
34182cd038dSYoshinobu Inoue 	return (0);
34282cd038dSYoshinobu Inoue }
34382cd038dSYoshinobu Inoue 
34482cd038dSYoshinobu Inoue /*
34582cd038dSYoshinobu Inoue  * Outer subroutine:
34682cd038dSYoshinobu Inoue  * Connect from a socket to a specified address.
34782cd038dSYoshinobu Inoue  * Both address and port must be specified in argument sin.
34882cd038dSYoshinobu Inoue  * If don't have a local address for this socket yet,
34982cd038dSYoshinobu Inoue  * then pick one.
35082cd038dSYoshinobu Inoue  */
35182cd038dSYoshinobu Inoue int
352b0330ed9SPawel Jakub Dawidek in6_pcbconnect(inp, nam, cred)
35382cd038dSYoshinobu Inoue 	register struct inpcb *inp;
35482cd038dSYoshinobu Inoue 	struct sockaddr *nam;
355b0330ed9SPawel Jakub Dawidek 	struct ucred *cred;
35682cd038dSYoshinobu Inoue {
35782cd038dSYoshinobu Inoue 	struct in6_addr *addr6;
35882cd038dSYoshinobu Inoue 	register struct sockaddr_in6 *sin6 = (struct sockaddr_in6 *)nam;
35982cd038dSYoshinobu Inoue 	int error;
36082cd038dSYoshinobu Inoue 
36107385abdSRobert Watson 	INP_INFO_WLOCK_ASSERT(inp->inp_pcbinfo);
36207385abdSRobert Watson 	INP_LOCK_ASSERT(inp);
36307385abdSRobert Watson 
36482cd038dSYoshinobu Inoue 	/*
36582cd038dSYoshinobu Inoue 	 * Call inner routine, to assign local interface address.
36688ff5695SSUZUKI Shinsuke 	 * in6_pcbladdr() may automatically fill in sin6_scope_id.
36782cd038dSYoshinobu Inoue 	 */
36882cd038dSYoshinobu Inoue 	if ((error = in6_pcbladdr(inp, nam, &addr6)) != 0)
36982cd038dSYoshinobu Inoue 		return (error);
37082cd038dSYoshinobu Inoue 
37182cd038dSYoshinobu Inoue 	if (in6_pcblookup_hash(inp->inp_pcbinfo, &sin6->sin6_addr,
37282cd038dSYoshinobu Inoue 			       sin6->sin6_port,
37382cd038dSYoshinobu Inoue 			      IN6_IS_ADDR_UNSPECIFIED(&inp->in6p_laddr)
37482cd038dSYoshinobu Inoue 			      ? addr6 : &inp->in6p_laddr,
37582cd038dSYoshinobu Inoue 			      inp->inp_lport, 0, NULL) != NULL) {
37682cd038dSYoshinobu Inoue 		return (EADDRINUSE);
37782cd038dSYoshinobu Inoue 	}
37882cd038dSYoshinobu Inoue 	if (IN6_IS_ADDR_UNSPECIFIED(&inp->in6p_laddr)) {
37982cd038dSYoshinobu Inoue 		if (inp->inp_lport == 0) {
380b0330ed9SPawel Jakub Dawidek 			error = in6_pcbbind(inp, (struct sockaddr *)0, cred);
38182cd038dSYoshinobu Inoue 			if (error)
38282cd038dSYoshinobu Inoue 				return (error);
38382cd038dSYoshinobu Inoue 		}
38482cd038dSYoshinobu Inoue 		inp->in6p_laddr = *addr6;
38582cd038dSYoshinobu Inoue 	}
38682cd038dSYoshinobu Inoue 	inp->in6p_faddr = sin6->sin6_addr;
38782cd038dSYoshinobu Inoue 	inp->inp_fport = sin6->sin6_port;
38833841545SHajimu UMEMOTO 	/* update flowinfo - draft-itojun-ipv6-flowlabel-api-00 */
38933841545SHajimu UMEMOTO 	inp->in6p_flowinfo &= ~IPV6_FLOWLABEL_MASK;
39033841545SHajimu UMEMOTO 	if (inp->in6p_flags & IN6P_AUTOFLOWLABEL)
391fb59c426SYoshinobu Inoue 		inp->in6p_flowinfo |=
392b79274baSHajimu UMEMOTO #ifdef RANDOM_IP_ID
393b79274baSHajimu UMEMOTO 		    (htonl(ip6_randomflowlabel()) & IPV6_FLOWLABEL_MASK);
394b79274baSHajimu UMEMOTO #else
395fb59c426SYoshinobu Inoue 		    (htonl(ip6_flow_seq++) & IPV6_FLOWLABEL_MASK);
396b79274baSHajimu UMEMOTO #endif
39782cd038dSYoshinobu Inoue 
39882cd038dSYoshinobu Inoue 	in_pcbrehash(inp);
399a1831058SHajimu UMEMOTO #ifdef IPSEC
400a1831058SHajimu UMEMOTO 	if (inp->inp_socket->so_type == SOCK_STREAM)
401a1831058SHajimu UMEMOTO 		ipsec_pcbconn(inp->inp_sp);
402a1831058SHajimu UMEMOTO #endif
40382cd038dSYoshinobu Inoue 	return (0);
40482cd038dSYoshinobu Inoue }
40582cd038dSYoshinobu Inoue 
40682cd038dSYoshinobu Inoue void
40782cd038dSYoshinobu Inoue in6_pcbdisconnect(inp)
40882cd038dSYoshinobu Inoue 	struct inpcb *inp;
40982cd038dSYoshinobu Inoue {
41007385abdSRobert Watson 
41107385abdSRobert Watson 	INP_INFO_WLOCK_ASSERT(inp->inp_pcbinfo);
41207385abdSRobert Watson 	INP_LOCK_ASSERT(inp);
41307385abdSRobert Watson 
41482cd038dSYoshinobu Inoue 	bzero((caddr_t)&inp->in6p_faddr, sizeof(inp->in6p_faddr));
41582cd038dSYoshinobu Inoue 	inp->inp_fport = 0;
41633841545SHajimu UMEMOTO 	/* clear flowinfo - draft-itojun-ipv6-flowlabel-api-00 */
41733841545SHajimu UMEMOTO 	inp->in6p_flowinfo &= ~IPV6_FLOWLABEL_MASK;
41882cd038dSYoshinobu Inoue 	in_pcbrehash(inp);
419a1831058SHajimu UMEMOTO #ifdef IPSEC
420a1831058SHajimu UMEMOTO 	ipsec_pcbdisconn(inp->inp_sp);
421a1831058SHajimu UMEMOTO #endif
4224cc20ab1SSeigo Tanimura 	if (inp->inp_socket->so_state & SS_NOFDREF)
42382cd038dSYoshinobu Inoue 		in6_pcbdetach(inp);
42482cd038dSYoshinobu Inoue }
42582cd038dSYoshinobu Inoue 
42682cd038dSYoshinobu Inoue void
42782cd038dSYoshinobu Inoue in6_pcbdetach(inp)
42882cd038dSYoshinobu Inoue 	struct inpcb *inp;
42982cd038dSYoshinobu Inoue {
43082cd038dSYoshinobu Inoue 	struct socket *so = inp->inp_socket;
43182cd038dSYoshinobu Inoue 	struct inpcbinfo *ipi = inp->inp_pcbinfo;
43282cd038dSYoshinobu Inoue 
43307385abdSRobert Watson 	INP_INFO_WLOCK_ASSERT(inp->inp_pcbinfo);
43407385abdSRobert Watson 	INP_LOCK_ASSERT(inp);
43507385abdSRobert Watson 
4360f36f0e8SHajimu UMEMOTO #if defined(IPSEC) || defined(FAST_IPSEC)
437333aa64dSBrian Feldman 	if (inp->in6p_sp != NULL)
43882cd038dSYoshinobu Inoue 		ipsec6_delete_pcbpolicy(inp);
43982cd038dSYoshinobu Inoue #endif /* IPSEC */
44082cd038dSYoshinobu Inoue 	inp->inp_gencnt = ++ipi->ipi_gencnt;
44182cd038dSYoshinobu Inoue 	in_pcbremlists(inp);
4427efe5d92SHajimu UMEMOTO 
443340c35deSJonathan Lemon 	if (so) {
444359fdba7SRobert Watson 		SOCK_LOCK(so);
445340c35deSJonathan Lemon 		so->so_pcb = NULL;
446b1e4abd2SMatthew Dillon 		sotryfree(so);
447340c35deSJonathan Lemon 	}
448f95d4633SHajimu UMEMOTO 
44933841545SHajimu UMEMOTO  	ip6_freepcbopts(inp->in6p_outputopts);
45033841545SHajimu UMEMOTO  	ip6_freemoptions(inp->in6p_moptions);
451fb59c426SYoshinobu Inoue 	/* Check and free IPv4 related resources in case of mapped addr */
452fb59c426SYoshinobu Inoue 	if (inp->inp_options)
453fb59c426SYoshinobu Inoue 		(void)m_free(inp->inp_options);
454fb59c426SYoshinobu Inoue 	ip_freemoptions(inp->inp_moptions);
45582cd038dSYoshinobu Inoue 	inp->inp_vflag = 0;
456bdc20552SJeffrey Hsu 	INP_LOCK_DESTROY(inp);
45794540027SJeff Roberson 	uma_zfree(ipi->ipi_zone, inp);
45882cd038dSYoshinobu Inoue }
45982cd038dSYoshinobu Inoue 
46026ef6ac4SDon Lewis struct sockaddr *
46126ef6ac4SDon Lewis in6_sockaddr(port, addr_p)
46226ef6ac4SDon Lewis 	in_port_t port;
46326ef6ac4SDon Lewis 	struct in6_addr *addr_p;
46426ef6ac4SDon Lewis {
46526ef6ac4SDon Lewis 	struct sockaddr_in6 *sin6;
46626ef6ac4SDon Lewis 
467a163d034SWarner Losh 	MALLOC(sin6, struct sockaddr_in6 *, sizeof *sin6, M_SONAME, M_WAITOK);
46826ef6ac4SDon Lewis 	bzero(sin6, sizeof *sin6);
46926ef6ac4SDon Lewis 	sin6->sin6_family = AF_INET6;
47026ef6ac4SDon Lewis 	sin6->sin6_len = sizeof(*sin6);
47126ef6ac4SDon Lewis 	sin6->sin6_port = port;
47226ef6ac4SDon Lewis 	sin6->sin6_addr = *addr_p;
47326ef6ac4SDon Lewis 	if (IN6_IS_SCOPE_LINKLOCAL(&sin6->sin6_addr))
47426ef6ac4SDon Lewis 		sin6->sin6_scope_id = ntohs(sin6->sin6_addr.s6_addr16[1]);
47526ef6ac4SDon Lewis 	else
47626ef6ac4SDon Lewis 		sin6->sin6_scope_id = 0;	/*XXX*/
47726ef6ac4SDon Lewis 	if (IN6_IS_SCOPE_LINKLOCAL(&sin6->sin6_addr))
47826ef6ac4SDon Lewis 		sin6->sin6_addr.s6_addr16[1] = 0;
47926ef6ac4SDon Lewis 
48026ef6ac4SDon Lewis 	return (struct sockaddr *)sin6;
48126ef6ac4SDon Lewis }
48226ef6ac4SDon Lewis 
48326ef6ac4SDon Lewis struct sockaddr *
48426ef6ac4SDon Lewis in6_v4mapsin6_sockaddr(port, addr_p)
48526ef6ac4SDon Lewis 	in_port_t port;
48626ef6ac4SDon Lewis 	struct in_addr *addr_p;
48726ef6ac4SDon Lewis {
48826ef6ac4SDon Lewis 	struct sockaddr_in sin;
48926ef6ac4SDon Lewis 	struct sockaddr_in6 *sin6_p;
49026ef6ac4SDon Lewis 
49126ef6ac4SDon Lewis 	bzero(&sin, sizeof sin);
49226ef6ac4SDon Lewis 	sin.sin_family = AF_INET;
49326ef6ac4SDon Lewis 	sin.sin_len = sizeof(sin);
49426ef6ac4SDon Lewis 	sin.sin_port = port;
49526ef6ac4SDon Lewis 	sin.sin_addr = *addr_p;
49626ef6ac4SDon Lewis 
49726ef6ac4SDon Lewis 	MALLOC(sin6_p, struct sockaddr_in6 *, sizeof *sin6_p, M_SONAME,
498a163d034SWarner Losh 		M_WAITOK);
49926ef6ac4SDon Lewis 	in6_sin_2_v4mapsin6(&sin, sin6_p);
50026ef6ac4SDon Lewis 
50126ef6ac4SDon Lewis 	return (struct sockaddr *)sin6_p;
50226ef6ac4SDon Lewis }
50326ef6ac4SDon Lewis 
50482cd038dSYoshinobu Inoue /*
50582cd038dSYoshinobu Inoue  * The calling convention of in6_setsockaddr() and in6_setpeeraddr() was
50682cd038dSYoshinobu Inoue  * modified to match the pru_sockaddr() and pru_peeraddr() entry points
50782cd038dSYoshinobu Inoue  * in struct pr_usrreqs, so that protocols can just reference then directly
50882cd038dSYoshinobu Inoue  * without the need for a wrapper function.  The socket must have a valid
50982cd038dSYoshinobu Inoue  * (i.e., non-nil) PCB, but it should be impossible to get an invalid one
51082cd038dSYoshinobu Inoue  * except through a kernel programming error, so it is acceptable to panic
51182cd038dSYoshinobu Inoue  * (or in this case trap) if the PCB is invalid.  (Actually, we don't trap
51282cd038dSYoshinobu Inoue  * because there actually /is/ a programming error somewhere... XXX)
51382cd038dSYoshinobu Inoue  */
51482cd038dSYoshinobu Inoue int
51582cd038dSYoshinobu Inoue in6_setsockaddr(so, nam)
51682cd038dSYoshinobu Inoue 	struct socket *so;
51782cd038dSYoshinobu Inoue 	struct sockaddr **nam;
51882cd038dSYoshinobu Inoue {
51982cd038dSYoshinobu Inoue 	int s;
52082cd038dSYoshinobu Inoue 	register struct inpcb *inp;
52126ef6ac4SDon Lewis 	struct in6_addr addr;
52226ef6ac4SDon Lewis 	in_port_t port;
52382cd038dSYoshinobu Inoue 
52482cd038dSYoshinobu Inoue 	s = splnet();
52582cd038dSYoshinobu Inoue 	inp = sotoinpcb(so);
52682cd038dSYoshinobu Inoue 	if (!inp) {
52782cd038dSYoshinobu Inoue 		splx(s);
52882cd038dSYoshinobu Inoue 		return EINVAL;
52982cd038dSYoshinobu Inoue 	}
53026ef6ac4SDon Lewis 	port = inp->inp_lport;
53126ef6ac4SDon Lewis 	addr = inp->in6p_laddr;
53282cd038dSYoshinobu Inoue 	splx(s);
53382cd038dSYoshinobu Inoue 
53426ef6ac4SDon Lewis 	*nam = in6_sockaddr(port, &addr);
53582cd038dSYoshinobu Inoue 	return 0;
53682cd038dSYoshinobu Inoue }
53782cd038dSYoshinobu Inoue 
53882cd038dSYoshinobu Inoue int
53982cd038dSYoshinobu Inoue in6_setpeeraddr(so, nam)
54082cd038dSYoshinobu Inoue 	struct socket *so;
54182cd038dSYoshinobu Inoue 	struct sockaddr **nam;
54282cd038dSYoshinobu Inoue {
54382cd038dSYoshinobu Inoue 	int s;
54482cd038dSYoshinobu Inoue 	struct inpcb *inp;
54526ef6ac4SDon Lewis 	struct in6_addr addr;
54626ef6ac4SDon Lewis 	in_port_t port;
54782cd038dSYoshinobu Inoue 
54882cd038dSYoshinobu Inoue 	s = splnet();
54982cd038dSYoshinobu Inoue 	inp = sotoinpcb(so);
55082cd038dSYoshinobu Inoue 	if (!inp) {
55182cd038dSYoshinobu Inoue 		splx(s);
55282cd038dSYoshinobu Inoue 		return EINVAL;
55382cd038dSYoshinobu Inoue 	}
55426ef6ac4SDon Lewis 	port = inp->inp_fport;
55526ef6ac4SDon Lewis 	addr = inp->in6p_faddr;
55682cd038dSYoshinobu Inoue 	splx(s);
55782cd038dSYoshinobu Inoue 
55826ef6ac4SDon Lewis 	*nam = in6_sockaddr(port, &addr);
55982cd038dSYoshinobu Inoue 	return 0;
56082cd038dSYoshinobu Inoue }
56182cd038dSYoshinobu Inoue 
56282cd038dSYoshinobu Inoue int
56382cd038dSYoshinobu Inoue in6_mapped_sockaddr(struct socket *so, struct sockaddr **nam)
56482cd038dSYoshinobu Inoue {
56582cd038dSYoshinobu Inoue 	struct	inpcb *inp = sotoinpcb(so);
56682cd038dSYoshinobu Inoue 	int	error;
56782cd038dSYoshinobu Inoue 
56882cd038dSYoshinobu Inoue 	if (inp == NULL)
56982cd038dSYoshinobu Inoue 		return EINVAL;
5705fac4178SHajimu UMEMOTO 	if ((inp->inp_vflag & (INP_IPV4 | INP_IPV6)) == INP_IPV4) {
571f76fcf6dSJeffrey Hsu 		error = in_setsockaddr(so, nam, &tcbinfo);
572369dc8ceSEivind Eklund 		if (error == 0)
57382cd038dSYoshinobu Inoue 			in6_sin_2_v4mapsin6_in_sock(nam);
5747efe5d92SHajimu UMEMOTO 	} else {
57588ff5695SSUZUKI Shinsuke 		/* scope issues will be handled in in6_setsockaddr(). */
57682cd038dSYoshinobu Inoue 		error = in6_setsockaddr(so, nam);
5777efe5d92SHajimu UMEMOTO 	}
57882cd038dSYoshinobu Inoue 
57982cd038dSYoshinobu Inoue 	return error;
58082cd038dSYoshinobu Inoue }
58182cd038dSYoshinobu Inoue 
58282cd038dSYoshinobu Inoue int
58382cd038dSYoshinobu Inoue in6_mapped_peeraddr(struct socket *so, struct sockaddr **nam)
58482cd038dSYoshinobu Inoue {
58582cd038dSYoshinobu Inoue 	struct	inpcb *inp = sotoinpcb(so);
58682cd038dSYoshinobu Inoue 	int	error;
58782cd038dSYoshinobu Inoue 
58882cd038dSYoshinobu Inoue 	if (inp == NULL)
58982cd038dSYoshinobu Inoue 		return EINVAL;
5905fac4178SHajimu UMEMOTO 	if ((inp->inp_vflag & (INP_IPV4 | INP_IPV6)) == INP_IPV4) {
591f76fcf6dSJeffrey Hsu 		error = in_setpeeraddr(so, nam, &tcbinfo);
592369dc8ceSEivind Eklund 		if (error == 0)
59382cd038dSYoshinobu Inoue 			in6_sin_2_v4mapsin6_in_sock(nam);
59482cd038dSYoshinobu Inoue 	} else
59588ff5695SSUZUKI Shinsuke 	/* scope issues will be handled in in6_setpeeraddr(). */
59682cd038dSYoshinobu Inoue 	error = in6_setpeeraddr(so, nam);
59782cd038dSYoshinobu Inoue 
59882cd038dSYoshinobu Inoue 	return error;
59982cd038dSYoshinobu Inoue }
60082cd038dSYoshinobu Inoue 
60182cd038dSYoshinobu Inoue /*
60282cd038dSYoshinobu Inoue  * Pass some notification to all connections of a protocol
60382cd038dSYoshinobu Inoue  * associated with address dst.  The local address and/or port numbers
60482cd038dSYoshinobu Inoue  * may be specified to limit the search.  The "usual action" will be
60582cd038dSYoshinobu Inoue  * taken, depending on the ctlinput cmd.  The caller must filter any
60682cd038dSYoshinobu Inoue  * cmds that are uninteresting (e.g., no error in the map).
60782cd038dSYoshinobu Inoue  * Call the protocol specific routine (if any) to report
60882cd038dSYoshinobu Inoue  * any errors for each matching socket.
60982cd038dSYoshinobu Inoue  *
61082cd038dSYoshinobu Inoue  * Must be called at splnet.
61182cd038dSYoshinobu Inoue  */
61282cd038dSYoshinobu Inoue void
613f31f65a7SRobert Watson in6_pcbnotify(pcbinfo, dst, fport_arg, src, lport_arg, cmd, cmdarg, notify)
614f31f65a7SRobert Watson 	struct inpcbinfo *pcbinfo;
615c4c0c592SAlfred Perlstein 	struct sockaddr *dst;
616c4c0c592SAlfred Perlstein 	const struct sockaddr *src;
61782cd038dSYoshinobu Inoue 	u_int fport_arg, lport_arg;
61882cd038dSYoshinobu Inoue 	int cmd;
619efddf5c6SHajimu UMEMOTO 	void *cmdarg;
6203ce144eaSJeffrey Hsu 	struct inpcb *(*notify) __P((struct inpcb *, int));
62182cd038dSYoshinobu Inoue {
622f31f65a7SRobert Watson 	struct inpcbhead *head;
623686cdd19SJun-ichiro itojun Hagino 	struct inpcb *inp, *ninp;
62433841545SHajimu UMEMOTO 	struct sockaddr_in6 sa6_src, *sa6_dst;
62582cd038dSYoshinobu Inoue 	u_short	fport = fport_arg, lport = lport_arg;
62633841545SHajimu UMEMOTO 	u_int32_t flowinfo;
62782cd038dSYoshinobu Inoue 	int errno, s;
62882cd038dSYoshinobu Inoue 
62978f94aa9SRuslan Ermilov 	if ((unsigned)cmd >= PRC_NCMDS || dst->sa_family != AF_INET6)
63082cd038dSYoshinobu Inoue 		return;
63133841545SHajimu UMEMOTO 
63233841545SHajimu UMEMOTO 	sa6_dst = (struct sockaddr_in6 *)dst;
63333841545SHajimu UMEMOTO 	if (IN6_IS_ADDR_UNSPECIFIED(&sa6_dst->sin6_addr))
63482cd038dSYoshinobu Inoue 		return;
63582cd038dSYoshinobu Inoue 
63682cd038dSYoshinobu Inoue 	/*
63733841545SHajimu UMEMOTO 	 * note that src can be NULL when we get notify by local fragmentation.
63833841545SHajimu UMEMOTO 	 */
639c4c0c592SAlfred Perlstein 	sa6_src = (src == NULL) ? sa6_any : *(const struct sockaddr_in6 *)src;
64033841545SHajimu UMEMOTO 	flowinfo = sa6_src.sin6_flowinfo;
64133841545SHajimu UMEMOTO 
64233841545SHajimu UMEMOTO 	/*
64382cd038dSYoshinobu Inoue 	 * Redirects go to all references to the destination,
644686cdd19SJun-ichiro itojun Hagino 	 * and use in6_rtchange to invalidate the route cache.
645686cdd19SJun-ichiro itojun Hagino 	 * Dead host indications: also use in6_rtchange to invalidate
646686cdd19SJun-ichiro itojun Hagino 	 * the cache, and deliver the error to all the sockets.
64782cd038dSYoshinobu Inoue 	 * Otherwise, if we have knowledge of the local port and address,
64882cd038dSYoshinobu Inoue 	 * deliver only to that socket.
64982cd038dSYoshinobu Inoue 	 */
65082cd038dSYoshinobu Inoue 	if (PRC_IS_REDIRECT(cmd) || cmd == PRC_HOSTDEAD) {
65182cd038dSYoshinobu Inoue 		fport = 0;
65282cd038dSYoshinobu Inoue 		lport = 0;
65333841545SHajimu UMEMOTO 		bzero((caddr_t)&sa6_src.sin6_addr, sizeof(sa6_src.sin6_addr));
654686cdd19SJun-ichiro itojun Hagino 
65533841545SHajimu UMEMOTO 		if (cmd != PRC_HOSTDEAD)
65633841545SHajimu UMEMOTO 			notify = in6_rtchange;
65782cd038dSYoshinobu Inoue 	}
65882cd038dSYoshinobu Inoue 	errno = inet6ctlerrmap[cmd];
65982cd038dSYoshinobu Inoue 	s = splnet();
660f31f65a7SRobert Watson 	head = pcbinfo->listhead;
661f31f65a7SRobert Watson 	INP_INFO_WLOCK(pcbinfo);
662686cdd19SJun-ichiro itojun Hagino  	for (inp = LIST_FIRST(head); inp != NULL; inp = ninp) {
663f31f65a7SRobert Watson 		INP_LOCK(inp);
664686cdd19SJun-ichiro itojun Hagino  		ninp = LIST_NEXT(inp, inp_list);
665686cdd19SJun-ichiro itojun Hagino 
666f31f65a7SRobert Watson  		if ((inp->inp_vflag & INP_IPV6) == 0) {
667f31f65a7SRobert Watson 			INP_UNLOCK(inp);
66882cd038dSYoshinobu Inoue 			continue;
669f31f65a7SRobert Watson 		}
670686cdd19SJun-ichiro itojun Hagino 
671686cdd19SJun-ichiro itojun Hagino 		/*
672efddf5c6SHajimu UMEMOTO 		 * If the error designates a new path MTU for a destination
673efddf5c6SHajimu UMEMOTO 		 * and the application (associated with this socket) wanted to
674efddf5c6SHajimu UMEMOTO 		 * know the value, notify. Note that we notify for all
675efddf5c6SHajimu UMEMOTO 		 * disconnected sockets if the corresponding application
676efddf5c6SHajimu UMEMOTO 		 * wanted. This is because some UDP applications keep sending
677efddf5c6SHajimu UMEMOTO 		 * sockets disconnected.
678efddf5c6SHajimu UMEMOTO 		 * XXX: should we avoid to notify the value to TCP sockets?
679efddf5c6SHajimu UMEMOTO 		 */
680efddf5c6SHajimu UMEMOTO 		if (cmd == PRC_MSGSIZE && (inp->inp_flags & IN6P_MTU) != 0 &&
681efddf5c6SHajimu UMEMOTO 		    (IN6_IS_ADDR_UNSPECIFIED(&inp->in6p_faddr) ||
682efddf5c6SHajimu UMEMOTO 		     IN6_ARE_ADDR_EQUAL(&inp->in6p_faddr, &sa6_dst->sin6_addr))) {
683efddf5c6SHajimu UMEMOTO 			ip6_notify_pmtu(inp, (struct sockaddr_in6 *)dst,
684efddf5c6SHajimu UMEMOTO 					(u_int32_t *)cmdarg);
685efddf5c6SHajimu UMEMOTO 		}
686efddf5c6SHajimu UMEMOTO 
687efddf5c6SHajimu UMEMOTO 		/*
68833841545SHajimu UMEMOTO 		 * Detect if we should notify the error. If no source and
68933841545SHajimu UMEMOTO 		 * destination ports are specifed, but non-zero flowinfo and
69033841545SHajimu UMEMOTO 		 * local address match, notify the error. This is the case
69133841545SHajimu UMEMOTO 		 * when the error is delivered with an encrypted buffer
69233841545SHajimu UMEMOTO 		 * by ESP. Otherwise, just compare addresses and ports
69333841545SHajimu UMEMOTO 		 * as usual.
694686cdd19SJun-ichiro itojun Hagino 		 */
69533841545SHajimu UMEMOTO 		if (lport == 0 && fport == 0 && flowinfo &&
69633841545SHajimu UMEMOTO 		    inp->inp_socket != NULL &&
69733841545SHajimu UMEMOTO 		    flowinfo == (inp->in6p_flowinfo & IPV6_FLOWLABEL_MASK) &&
69833841545SHajimu UMEMOTO 		    IN6_ARE_ADDR_EQUAL(&inp->in6p_laddr, &sa6_src.sin6_addr))
69933841545SHajimu UMEMOTO 			goto do_notify;
70033841545SHajimu UMEMOTO 		else if (!IN6_ARE_ADDR_EQUAL(&inp->in6p_faddr,
70133841545SHajimu UMEMOTO 					     &sa6_dst->sin6_addr) ||
70282cd038dSYoshinobu Inoue 			 inp->inp_socket == 0 ||
70382cd038dSYoshinobu Inoue 			 (lport && inp->inp_lport != lport) ||
70433841545SHajimu UMEMOTO 			 (!IN6_IS_ADDR_UNSPECIFIED(&sa6_src.sin6_addr) &&
70533841545SHajimu UMEMOTO 			  !IN6_ARE_ADDR_EQUAL(&inp->in6p_laddr,
70633841545SHajimu UMEMOTO 					      &sa6_src.sin6_addr)) ||
707f31f65a7SRobert Watson 			 (fport && inp->inp_fport != fport)) {
708f31f65a7SRobert Watson 			INP_UNLOCK(inp);
70982cd038dSYoshinobu Inoue 			continue;
710f31f65a7SRobert Watson 		}
711686cdd19SJun-ichiro itojun Hagino 
71233841545SHajimu UMEMOTO 	  do_notify:
71382cd038dSYoshinobu Inoue 		if (notify)
714686cdd19SJun-ichiro itojun Hagino 			(*notify)(inp, errno);
715f31f65a7SRobert Watson 		INP_UNLOCK(inp);
71682cd038dSYoshinobu Inoue 	}
717f31f65a7SRobert Watson 	INP_INFO_WUNLOCK(pcbinfo);
71882cd038dSYoshinobu Inoue 	splx(s);
71982cd038dSYoshinobu Inoue }
72082cd038dSYoshinobu Inoue 
72182cd038dSYoshinobu Inoue /*
72282cd038dSYoshinobu Inoue  * Lookup a PCB based on the local address and port.
72382cd038dSYoshinobu Inoue  */
72482cd038dSYoshinobu Inoue struct inpcb *
72582cd038dSYoshinobu Inoue in6_pcblookup_local(pcbinfo, laddr, lport_arg, wild_okay)
72682cd038dSYoshinobu Inoue 	struct inpcbinfo *pcbinfo;
72782cd038dSYoshinobu Inoue 	struct in6_addr *laddr;
72882cd038dSYoshinobu Inoue 	u_int lport_arg;
72982cd038dSYoshinobu Inoue 	int wild_okay;
73082cd038dSYoshinobu Inoue {
73182cd038dSYoshinobu Inoue 	register struct inpcb *inp;
73282cd038dSYoshinobu Inoue 	int matchwild = 3, wildcard;
73382cd038dSYoshinobu Inoue 	u_short lport = lport_arg;
73482cd038dSYoshinobu Inoue 
73582cd038dSYoshinobu Inoue 	if (!wild_okay) {
73682cd038dSYoshinobu Inoue 		struct inpcbhead *head;
73782cd038dSYoshinobu Inoue 		/*
73882cd038dSYoshinobu Inoue 		 * Look for an unconnected (wildcard foreign addr) PCB that
73982cd038dSYoshinobu Inoue 		 * matches the local address and port we're looking for.
74082cd038dSYoshinobu Inoue 		 */
74182cd038dSYoshinobu Inoue 		head = &pcbinfo->hashbase[INP_PCBHASH(INADDR_ANY, lport, 0,
74282cd038dSYoshinobu Inoue 						      pcbinfo->hashmask)];
74382cd038dSYoshinobu Inoue 		LIST_FOREACH(inp, head, inp_hash) {
744369dc8ceSEivind Eklund 			if ((inp->inp_vflag & INP_IPV6) == 0)
74582cd038dSYoshinobu Inoue 				continue;
74682cd038dSYoshinobu Inoue 			if (IN6_IS_ADDR_UNSPECIFIED(&inp->in6p_faddr) &&
74782cd038dSYoshinobu Inoue 			    IN6_ARE_ADDR_EQUAL(&inp->in6p_laddr, laddr) &&
74882cd038dSYoshinobu Inoue 			    inp->inp_lport == lport) {
74982cd038dSYoshinobu Inoue 				/*
75082cd038dSYoshinobu Inoue 				 * Found.
75182cd038dSYoshinobu Inoue 				 */
75282cd038dSYoshinobu Inoue 				return (inp);
75382cd038dSYoshinobu Inoue 			}
75482cd038dSYoshinobu Inoue 		}
75582cd038dSYoshinobu Inoue 		/*
75682cd038dSYoshinobu Inoue 		 * Not found.
75782cd038dSYoshinobu Inoue 		 */
75882cd038dSYoshinobu Inoue 		return (NULL);
75982cd038dSYoshinobu Inoue 	} else {
76082cd038dSYoshinobu Inoue 		struct inpcbporthead *porthash;
76182cd038dSYoshinobu Inoue 		struct inpcbport *phd;
76282cd038dSYoshinobu Inoue 		struct inpcb *match = NULL;
76382cd038dSYoshinobu Inoue 		/*
76482cd038dSYoshinobu Inoue 		 * Best fit PCB lookup.
76582cd038dSYoshinobu Inoue 		 *
76682cd038dSYoshinobu Inoue 		 * First see if this local port is in use by looking on the
76782cd038dSYoshinobu Inoue 		 * port hash list.
76882cd038dSYoshinobu Inoue 		 */
76982cd038dSYoshinobu Inoue 		porthash = &pcbinfo->porthashbase[INP_PCBPORTHASH(lport,
77082cd038dSYoshinobu Inoue 		    pcbinfo->porthashmask)];
77182cd038dSYoshinobu Inoue 		LIST_FOREACH(phd, porthash, phd_hash) {
77282cd038dSYoshinobu Inoue 			if (phd->phd_port == lport)
77382cd038dSYoshinobu Inoue 				break;
77482cd038dSYoshinobu Inoue 		}
77582cd038dSYoshinobu Inoue 		if (phd != NULL) {
77682cd038dSYoshinobu Inoue 			/*
77782cd038dSYoshinobu Inoue 			 * Port is in use by one or more PCBs. Look for best
77882cd038dSYoshinobu Inoue 			 * fit.
77982cd038dSYoshinobu Inoue 			 */
78082cd038dSYoshinobu Inoue 			LIST_FOREACH(inp, &phd->phd_pcblist, inp_portlist) {
78182cd038dSYoshinobu Inoue 				wildcard = 0;
782369dc8ceSEivind Eklund 				if ((inp->inp_vflag & INP_IPV6) == 0)
78382cd038dSYoshinobu Inoue 					continue;
78482cd038dSYoshinobu Inoue 				if (!IN6_IS_ADDR_UNSPECIFIED(&inp->in6p_faddr))
78582cd038dSYoshinobu Inoue 					wildcard++;
78682cd038dSYoshinobu Inoue 				if (!IN6_IS_ADDR_UNSPECIFIED(
78782cd038dSYoshinobu Inoue 					&inp->in6p_laddr)) {
78882cd038dSYoshinobu Inoue 					if (IN6_IS_ADDR_UNSPECIFIED(laddr))
78982cd038dSYoshinobu Inoue 						wildcard++;
79082cd038dSYoshinobu Inoue 					else if (!IN6_ARE_ADDR_EQUAL(
79182cd038dSYoshinobu Inoue 						&inp->in6p_laddr, laddr))
79282cd038dSYoshinobu Inoue 						continue;
79382cd038dSYoshinobu Inoue 				} else {
79482cd038dSYoshinobu Inoue 					if (!IN6_IS_ADDR_UNSPECIFIED(laddr))
79582cd038dSYoshinobu Inoue 						wildcard++;
79682cd038dSYoshinobu Inoue 				}
79782cd038dSYoshinobu Inoue 				if (wildcard < matchwild) {
79882cd038dSYoshinobu Inoue 					match = inp;
79982cd038dSYoshinobu Inoue 					matchwild = wildcard;
80082cd038dSYoshinobu Inoue 					if (matchwild == 0) {
80182cd038dSYoshinobu Inoue 						break;
80282cd038dSYoshinobu Inoue 					}
80382cd038dSYoshinobu Inoue 				}
80482cd038dSYoshinobu Inoue 			}
80582cd038dSYoshinobu Inoue 		}
80682cd038dSYoshinobu Inoue 		return (match);
80782cd038dSYoshinobu Inoue 	}
80882cd038dSYoshinobu Inoue }
80982cd038dSYoshinobu Inoue 
810e43cc4aeSHajimu UMEMOTO void
811e43cc4aeSHajimu UMEMOTO in6_pcbpurgeif0(head, ifp)
812e43cc4aeSHajimu UMEMOTO 	struct in6pcb *head;
813e43cc4aeSHajimu UMEMOTO 	struct ifnet *ifp;
814e43cc4aeSHajimu UMEMOTO {
815e43cc4aeSHajimu UMEMOTO 	struct in6pcb *in6p;
816e43cc4aeSHajimu UMEMOTO 	struct ip6_moptions *im6o;
817e43cc4aeSHajimu UMEMOTO 	struct in6_multi_mship *imm, *nimm;
818e43cc4aeSHajimu UMEMOTO 
819e43cc4aeSHajimu UMEMOTO 	for (in6p = head; in6p != NULL; in6p = LIST_NEXT(in6p, inp_list)) {
820e43cc4aeSHajimu UMEMOTO 		im6o = in6p->in6p_moptions;
821e43cc4aeSHajimu UMEMOTO 		if ((in6p->inp_vflag & INP_IPV6) &&
822e43cc4aeSHajimu UMEMOTO 		    im6o) {
823e43cc4aeSHajimu UMEMOTO 			/*
824e43cc4aeSHajimu UMEMOTO 			 * Unselect the outgoing interface if it is being
825e43cc4aeSHajimu UMEMOTO 			 * detached.
826e43cc4aeSHajimu UMEMOTO 			 */
827e43cc4aeSHajimu UMEMOTO 			if (im6o->im6o_multicast_ifp == ifp)
828e43cc4aeSHajimu UMEMOTO 				im6o->im6o_multicast_ifp = NULL;
829e43cc4aeSHajimu UMEMOTO 
830e43cc4aeSHajimu UMEMOTO 			/*
831e43cc4aeSHajimu UMEMOTO 			 * Drop multicast group membership if we joined
832e43cc4aeSHajimu UMEMOTO 			 * through the interface being detached.
833e43cc4aeSHajimu UMEMOTO 			 * XXX controversial - is it really legal for kernel
834e43cc4aeSHajimu UMEMOTO 			 * to force this?
835e43cc4aeSHajimu UMEMOTO 			 */
836e43cc4aeSHajimu UMEMOTO 			for (imm = im6o->im6o_memberships.lh_first;
837e43cc4aeSHajimu UMEMOTO 			     imm != NULL; imm = nimm) {
838e43cc4aeSHajimu UMEMOTO 				nimm = imm->i6mm_chain.le_next;
839e43cc4aeSHajimu UMEMOTO 				if (imm->i6mm_maddr->in6m_ifp == ifp) {
840e43cc4aeSHajimu UMEMOTO 					LIST_REMOVE(imm, i6mm_chain);
841e43cc4aeSHajimu UMEMOTO 					in6_delmulti(imm->i6mm_maddr);
842e43cc4aeSHajimu UMEMOTO 					free(imm, M_IPMADDR);
843e43cc4aeSHajimu UMEMOTO 				}
844e43cc4aeSHajimu UMEMOTO 			}
845e43cc4aeSHajimu UMEMOTO 		}
846e43cc4aeSHajimu UMEMOTO 	}
847e43cc4aeSHajimu UMEMOTO }
848e43cc4aeSHajimu UMEMOTO 
84982cd038dSYoshinobu Inoue /*
85082cd038dSYoshinobu Inoue  * Check for alternatives when higher level complains
85182cd038dSYoshinobu Inoue  * about service problems.  For now, invalidate cached
85282cd038dSYoshinobu Inoue  * routing information.  If the route was created dynamically
85382cd038dSYoshinobu Inoue  * (by a redirect), time to try a default gateway again.
85482cd038dSYoshinobu Inoue  */
85582cd038dSYoshinobu Inoue void
85682cd038dSYoshinobu Inoue in6_losing(in6p)
85782cd038dSYoshinobu Inoue 	struct inpcb *in6p;
85882cd038dSYoshinobu Inoue {
85982cd038dSYoshinobu Inoue 	/*
86097d8d152SAndre Oppermann 	 * We don't store route pointers in the routing table anymore
86182cd038dSYoshinobu Inoue 	 */
86297d8d152SAndre Oppermann 	return;
86382cd038dSYoshinobu Inoue }
86482cd038dSYoshinobu Inoue 
86582cd038dSYoshinobu Inoue /*
86682cd038dSYoshinobu Inoue  * After a routing change, flush old routing
86782cd038dSYoshinobu Inoue  * and allocate a (hopefully) better one.
86882cd038dSYoshinobu Inoue  */
8693ce144eaSJeffrey Hsu struct inpcb *
87082cd038dSYoshinobu Inoue in6_rtchange(inp, errno)
87182cd038dSYoshinobu Inoue 	struct inpcb *inp;
87282cd038dSYoshinobu Inoue 	int errno;
87382cd038dSYoshinobu Inoue {
87482cd038dSYoshinobu Inoue 	/*
87597d8d152SAndre Oppermann 	 * We don't store route pointers in the routing table anymore
87682cd038dSYoshinobu Inoue 	 */
8773ce144eaSJeffrey Hsu 	return inp;
87882cd038dSYoshinobu Inoue }
87982cd038dSYoshinobu Inoue 
88082cd038dSYoshinobu Inoue /*
88182cd038dSYoshinobu Inoue  * Lookup PCB in hash list.
88282cd038dSYoshinobu Inoue  */
88382cd038dSYoshinobu Inoue struct inpcb *
88482cd038dSYoshinobu Inoue in6_pcblookup_hash(pcbinfo, faddr, fport_arg, laddr, lport_arg, wildcard, ifp)
88582cd038dSYoshinobu Inoue 	struct inpcbinfo *pcbinfo;
88682cd038dSYoshinobu Inoue 	struct in6_addr *faddr, *laddr;
88782cd038dSYoshinobu Inoue 	u_int fport_arg, lport_arg;
88882cd038dSYoshinobu Inoue 	int wildcard;
88982cd038dSYoshinobu Inoue 	struct ifnet *ifp;
89082cd038dSYoshinobu Inoue {
89182cd038dSYoshinobu Inoue 	struct inpcbhead *head;
89282cd038dSYoshinobu Inoue 	register struct inpcb *inp;
89382cd038dSYoshinobu Inoue 	u_short fport = fport_arg, lport = lport_arg;
89433841545SHajimu UMEMOTO 	int faith;
89533841545SHajimu UMEMOTO 
8969494d596SBrooks Davis 	if (faithprefix_p != NULL)
8979494d596SBrooks Davis 		faith = (*faithprefix_p)(laddr);
8989494d596SBrooks Davis 	else
89933841545SHajimu UMEMOTO 		faith = 0;
90082cd038dSYoshinobu Inoue 
90182cd038dSYoshinobu Inoue 	/*
90282cd038dSYoshinobu Inoue 	 * First look for an exact match.
90382cd038dSYoshinobu Inoue 	 */
90482cd038dSYoshinobu Inoue 	head = &pcbinfo->hashbase[INP_PCBHASH(faddr->s6_addr32[3] /* XXX */,
90582cd038dSYoshinobu Inoue 					      lport, fport,
90682cd038dSYoshinobu Inoue 					      pcbinfo->hashmask)];
907cfa1ca9dSYoshinobu Inoue 	LIST_FOREACH(inp, head, inp_hash) {
908369dc8ceSEivind Eklund 		if ((inp->inp_vflag & INP_IPV6) == 0)
90982cd038dSYoshinobu Inoue 			continue;
91082cd038dSYoshinobu Inoue 		if (IN6_ARE_ADDR_EQUAL(&inp->in6p_faddr, faddr) &&
91182cd038dSYoshinobu Inoue 		    IN6_ARE_ADDR_EQUAL(&inp->in6p_laddr, laddr) &&
91282cd038dSYoshinobu Inoue 		    inp->inp_fport == fport &&
91382cd038dSYoshinobu Inoue 		    inp->inp_lport == lport) {
91482cd038dSYoshinobu Inoue 			/*
91582cd038dSYoshinobu Inoue 			 * Found.
91682cd038dSYoshinobu Inoue 			 */
91782cd038dSYoshinobu Inoue 			return (inp);
91882cd038dSYoshinobu Inoue 		}
91982cd038dSYoshinobu Inoue 	}
92082cd038dSYoshinobu Inoue 	if (wildcard) {
92182cd038dSYoshinobu Inoue 		struct inpcb *local_wild = NULL;
92282cd038dSYoshinobu Inoue 
92382cd038dSYoshinobu Inoue 		head = &pcbinfo->hashbase[INP_PCBHASH(INADDR_ANY, lport, 0,
92482cd038dSYoshinobu Inoue 						      pcbinfo->hashmask)];
925cfa1ca9dSYoshinobu Inoue 		LIST_FOREACH(inp, head, inp_hash) {
926369dc8ceSEivind Eklund 			if ((inp->inp_vflag & INP_IPV6) == 0)
92782cd038dSYoshinobu Inoue 				continue;
92882cd038dSYoshinobu Inoue 			if (IN6_IS_ADDR_UNSPECIFIED(&inp->in6p_faddr) &&
92982cd038dSYoshinobu Inoue 			    inp->inp_lport == lport) {
93033841545SHajimu UMEMOTO 				if (faith && (inp->inp_flags & INP_FAITH) == 0)
93182cd038dSYoshinobu Inoue 					continue;
93282cd038dSYoshinobu Inoue 				if (IN6_ARE_ADDR_EQUAL(&inp->in6p_laddr,
93382cd038dSYoshinobu Inoue 						       laddr))
93482cd038dSYoshinobu Inoue 					return (inp);
93582cd038dSYoshinobu Inoue 				else if (IN6_IS_ADDR_UNSPECIFIED(&inp->in6p_laddr))
93682cd038dSYoshinobu Inoue 					local_wild = inp;
93782cd038dSYoshinobu Inoue 			}
93882cd038dSYoshinobu Inoue 		}
93982cd038dSYoshinobu Inoue 		return (local_wild);
94082cd038dSYoshinobu Inoue 	}
94182cd038dSYoshinobu Inoue 
94282cd038dSYoshinobu Inoue 	/*
94382cd038dSYoshinobu Inoue 	 * Not found.
94482cd038dSYoshinobu Inoue 	 */
94582cd038dSYoshinobu Inoue 	return (NULL);
94682cd038dSYoshinobu Inoue }
94782cd038dSYoshinobu Inoue 
94882cd038dSYoshinobu Inoue void
94982cd038dSYoshinobu Inoue init_sin6(struct sockaddr_in6 *sin6, struct mbuf *m)
95082cd038dSYoshinobu Inoue {
95182cd038dSYoshinobu Inoue 	struct ip6_hdr *ip;
95282cd038dSYoshinobu Inoue 
95382cd038dSYoshinobu Inoue 	ip = mtod(m, struct ip6_hdr *);
95482cd038dSYoshinobu Inoue 	bzero(sin6, sizeof(*sin6));
95582cd038dSYoshinobu Inoue 	sin6->sin6_len = sizeof(*sin6);
95682cd038dSYoshinobu Inoue 	sin6->sin6_family = AF_INET6;
95782cd038dSYoshinobu Inoue 	sin6->sin6_addr = ip->ip6_src;
95882cd038dSYoshinobu Inoue 	if (IN6_IS_SCOPE_LINKLOCAL(&sin6->sin6_addr))
95982cd038dSYoshinobu Inoue 		sin6->sin6_addr.s6_addr16[1] = 0;
96082cd038dSYoshinobu Inoue 	sin6->sin6_scope_id =
96182cd038dSYoshinobu Inoue 		(m->m_pkthdr.rcvif && IN6_IS_SCOPE_LINKLOCAL(&sin6->sin6_addr))
96282cd038dSYoshinobu Inoue 		? m->m_pkthdr.rcvif->if_index : 0;
96382cd038dSYoshinobu Inoue 
96482cd038dSYoshinobu Inoue 	return;
96582cd038dSYoshinobu Inoue }
966