sys/netinet6/in6_pcb.c

   1 /*      $FreeBSD: src/sys/netinet6/in6_pcb.c,v 1.10.2.9 2003/01/24 05:11:35 sam Exp $   */
   2 /*      $DragonFly: src/sys/netinet6/in6_pcb.c,v 1.33 2006/12/29 18:02:56 victor Exp $  */
   3 /*      $KAME: in6_pcb.c,v 1.31 2001/05/21 05:45:10 jinmei Exp $        */
   4
   5 /*
   6  * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project.
   7  * All rights reserved.
   8  *
   9  * Redistribution and use in source and binary forms, with or without
  10  * modification, are permitted provided that the following conditions
  11  * are met:
  12  * 1. Redistributions of source code must retain the above copyright
  13  *    notice, this list of conditions and the following disclaimer.
  14  * 2. Redistributions in binary form must reproduce the above copyright
  15  *    notice, this list of conditions and the following disclaimer in the
  16  *    documentation and/or other materials provided with the distribution.
  17  * 3. Neither the name of the project nor the names of its contributors
  18  *    may be used to endorse or promote products derived from this software
  19  *    without specific prior written permission.
  20  *
  21  * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
  22  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  23  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  24  * ARE DISCLAIMED.  IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
  25  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  26  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  27  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  28  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  29  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  30  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  31  * SUCH DAMAGE.
  32  *
  33  */
  34
  35 /*
  36  * Copyright (c) 1982, 1986, 1991, 1993
  37  *      The Regents of the University of California.  All rights reserved.
  38  *
  39  * Redistribution and use in source and binary forms, with or without
  40  * modification, are permitted provided that the following conditions
  41  * are met:
  42  * 1. Redistributions of source code must retain the above copyright
  43  *    notice, this list of conditions and the following disclaimer.
  44  * 2. Redistributions in binary form must reproduce the above copyright
  45  *    notice, this list of conditions and the following disclaimer in the
  46  *    documentation and/or other materials provided with the distribution.
  47  * 3. All advertising materials mentioning features or use of this software
  48  *    must display the following acknowledgement:
  49  *      This product includes software developed by the University of
  50  *      California, Berkeley and its contributors.
  51  * 4. Neither the name of the University nor the names of its contributors
  52  *    may be used to endorse or promote products derived from this software
  53  *    without specific prior written permission.
  54  *
  55  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
  56  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  57  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  58  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
  59  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  60  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  61  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  62  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  63  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  64  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  65  * SUCH DAMAGE.
  66  *
  67  *      @(#)in_pcb.c    8.2 (Berkeley) 1/4/94
  68  */
  69
  70 #include "opt_inet.h"
  71 #include "opt_inet6.h"
  72 #include "opt_ipsec.h"
  73
  74 #include <sys/param.h>
  75 #include <sys/systm.h>
  76 #include <sys/malloc.h>
  77 #include <sys/mbuf.h>
  78 #include <sys/domain.h>
  79 #include <sys/protosw.h>
  80 #include <sys/socket.h>
  81 #include <sys/socketvar.h>
  82 #include <sys/sockio.h>
  83 #include <sys/errno.h>
  84 #include <sys/time.h>
  85 #include <sys/proc.h>
  86 #include <sys/jail.h>
  87 #include <sys/thread2.h>
  88
  89 #include <vm/vm_zone.h>
  90
  91 #include <net/if.h>
  92 #include <net/if_types.h>
  93 #include <net/route.h>
  94
  95 #include <netinet/in.h>
  96 #include <netinet/in_var.h>
  97 #include <netinet/in_systm.h>
  98 #include <netinet/ip6.h>
  99 #include <netinet/ip_var.h>
 100 #include <netinet6/ip6_var.h>
 101 #include <netinet6/nd6.h>
 102 #include <netinet/in_pcb.h>
 103 #include <netinet6/in6_pcb.h>
 104
 105 #ifdef IPSEC
 106 #include <netinet6/ipsec.h>
 107 #ifdef INET6
 108 #include <netinet6/ipsec6.h>
 109 #endif
 110 #include <netinet6/ah.h>
 111 #ifdef INET6
 112 #include <netinet6/ah6.h>
 113 #endif
 114 #include <netproto/key/key.h>
 115 #endif /* IPSEC */
 116
 117 #ifdef FAST_IPSEC
 118 #include <netproto/ipsec/ipsec.h>
 119 #include <netproto/ipsec/ipsec6.h>
 120 #include <netproto/ipsec/key.h>
 121 #define IPSEC
 122 #endif /* FAST_IPSEC */
 123
 124 struct  in6_addr zeroin6_addr;
 125
 126 int
 127 in6_pcbbind(struct inpcb *inp, struct sockaddr *nam, struct thread *td)
 128 {
 129         struct socket *so = inp->inp_socket;
 130         struct sockaddr_in6 *sin6 = (struct sockaddr_in6 *)NULL;
 131         struct sockaddr_in6 jsin6;
 132         struct inpcbinfo *pcbinfo = inp->inp_pcbinfo;
 133         struct proc *p = td->td_proc;
 134         struct ucred *cred = NULL;
 135         u_short lport = 0;
 136         int wild = 0, reuseport = (so->so_options & SO_REUSEPORT);
 137
 138         if (!in6_ifaddr) /* XXX broken! */
 139                 return (EADDRNOTAVAIL);
 140         if (inp->inp_lport || !IN6_IS_ADDR_UNSPECIFIED(&inp->in6p_laddr))
 141                 return (EINVAL);
 142         if ((so->so_options & (SO_REUSEADDR|SO_REUSEPORT)) == 0)
 143                 wild = 1;
 144         if (p)
 145                 cred = p->p_ucred;
 146         if (nam) {
 147                 sin6 = (struct sockaddr_in6 *)nam;
 148                 if (nam->sa_len != sizeof(*sin6))
 149                         return (EINVAL);
 150                 /*
 151                  * family check.
 152                  */
 153                 if (nam->sa_family != AF_INET6)
 154                         return (EAFNOSUPPORT);
 155
 156                 if (!prison_replace_wildcards(td, nam))
 157                         return (EINVAL);
 158
 159                 /* KAME hack: embed scopeid */
 160                 if (in6_embedscope(&sin6->sin6_addr, sin6, inp, NULL) != 0)
 161                         return EINVAL;
 162                 /* this must be cleared for ifa_ifwithaddr() */
 163                 sin6->sin6_scope_id = 0;
 164
 165                 lport = sin6->sin6_port;
 166                 if (IN6_IS_ADDR_MULTICAST(&sin6->sin6_addr)) {
 167                         /*
 168                          * Treat SO_REUSEADDR as SO_REUSEPORT for multicast;
 169                          * allow compepte duplication of binding if
 170                          * SO_REUSEPORT is set, or if SO_REUSEADDR is set
 171                          * and a multicast address is bound on both
 172                          * new and duplicated sockets.
 173                          */
 174                         if (so->so_options & SO_REUSEADDR)
 175                                 reuseport = SO_REUSEADDR|SO_REUSEPORT;
 176                 } else if (!IN6_IS_ADDR_UNSPECIFIED(&sin6->sin6_addr)) {
 177                         struct ifaddr *ia = NULL;
 178
 179                         sin6->sin6_port = 0;            /* yech... */
 180                         if (!prison_replace_wildcards(td, (struct sockaddr *)sin6)) {
 181                                 sin6->sin6_addr = kin6addr_any;
 182                                 return(EINVAL);
 183                         }
 184                         if ((ia = ifa_ifwithaddr((struct sockaddr *)sin6)) == 0)
 185                                 return (EADDRNOTAVAIL);
 186
 187                         /*
 188                          * XXX: bind to an anycast address might accidentally
 189                          * cause sending a packet with anycast source address.
 190                          * We should allow to bind to a deprecated address, since
 191                          * the application dare to use it.
 192                          */
 193                         if (ia &&
 194                             ((struct in6_ifaddr *)ia)->ia6_flags &
 195                             (IN6_IFF_ANYCAST|IN6_IFF_NOTREADY|IN6_IFF_DETACHED)) {
 196                                 return (EADDRNOTAVAIL);
 197                         }
 198                 }
 199                 if (lport) {
 200                         struct inpcb *t;
 201
 202                         /* GROSS */
 203                         if (ntohs(lport) < IPV6PORT_RESERVED && cred &&
 204                             suser_cred(cred, PRISON_ROOT))
 205                                 return (EACCES);
 206                         if (so->so_cred->cr_uid != 0 &&
 207                             !IN6_IS_ADDR_MULTICAST(&sin6->sin6_addr)) {
 208                                 t = in6_pcblookup_local(pcbinfo,
 209                                     &sin6->sin6_addr, lport,
 210                                     INPLOOKUP_WILDCARD, cred);
 211                                 if (t &&
 212                                     (!IN6_IS_ADDR_UNSPECIFIED(&sin6->sin6_addr) ||
 213                                      !IN6_IS_ADDR_UNSPECIFIED(&t->in6p_laddr) ||
 214                                      (t->inp_socket->so_options &
 215                                       SO_REUSEPORT) == 0) &&
 216                                     (so->so_cred->cr_uid !=
 217                                      t->inp_socket->so_cred->cr_uid))
 218                                         return (EADDRINUSE);
 219                                 if ((inp->inp_flags & IN6P_IPV6_V6ONLY) == 0 &&
 220                                     IN6_IS_ADDR_UNSPECIFIED(&sin6->sin6_addr)) {
 221                                         struct sockaddr_in sin;
 222
 223                                         in6_sin6_2_sin(&sin, sin6);
 224                                         t = in_pcblookup_local(pcbinfo,
 225                                                 sin.sin_addr, lport,
 226                                                 INPLOOKUP_WILDCARD, cred);
 227                                         if (t &&
 228                                             (so->so_cred->cr_uid !=
 229                                              t->inp_socket->so_cred->cr_uid) &&
 230                                             (ntohl(t->inp_laddr.s_addr) !=
 231                                              INADDR_ANY ||
 232                                              INP_SOCKAF(so) ==
 233                                              INP_SOCKAF(t->inp_socket)))
 234                                                 return (EADDRINUSE);
 235                                 }
 236                         }
 237                         if (cred && cred->cr_prison &&
 238                             !prison_replace_wildcards(td, nam))
 239                                 return(EADDRNOTAVAIL);
 240                         t = in6_pcblookup_local(pcbinfo, &sin6->sin6_addr,
 241                                                 lport, wild, cred);
 242                         if (t && (reuseport & t->inp_socket->so_options) == 0)
 243                                 return (EADDRINUSE);
 244                         if ((inp->inp_flags & IN6P_IPV6_V6ONLY) == 0 &&
 245                             IN6_IS_ADDR_UNSPECIFIED(&sin6->sin6_addr)) {
 246                                 struct sockaddr_in sin;
 247
 248                                 in6_sin6_2_sin(&sin, sin6);
 249                                 t = in_pcblookup_local(pcbinfo,
 250                                                        sin.sin_addr, lport,
 251                                                        wild, cred);
 252                                 if (t &&
 253                                     (reuseport & t->inp_socket->so_options)
 254                                     == 0 &&
 255                                     (ntohl(t->inp_laddr.s_addr)
 256                                      != INADDR_ANY ||
 257                                      INP_SOCKAF(so) ==
 258                                      INP_SOCKAF(t->inp_socket)))
 259                                         return (EADDRINUSE);
 260                         }
 261                 }
 262                 inp->in6p_laddr = sin6->sin6_addr;
 263         }
 264         if (lport == 0) {
 265                 int e;
 266
 267                 jsin6.sin6_addr = inp->in6p_laddr;
 268                 jsin6.sin6_family = AF_INET6;
 269                 if (!prison_replace_wildcards(td, (struct sockaddr*)&jsin6)) {
 270                         inp->in6p_laddr = kin6addr_any;
 271                         inp->inp_lport = 0;
 272                         return (EINVAL);
 273                 }
 274
 275                 if ((e = in6_pcbsetport(&inp->in6p_laddr, inp, td)) != 0)
 276                         return (e);
 277         }
 278         else {
 279                 inp->inp_lport = lport;
 280                 if (in_pcbinsporthash(inp) != 0) {
 281                         inp->in6p_laddr = kin6addr_any;
 282                         inp->inp_lport = 0;
 283                         return (EAGAIN);
 284                 }
 285         }
 286         return (0);
 287 }
 288
 289 /*
 290  *   Transform old in6_pcbconnect() into an inner subroutine for new
 291  *   in6_pcbconnect(): Do some validity-checking on the remote
 292  *   address (in mbuf 'nam') and then determine local host address
 293  *   (i.e., which interface) to use to access that remote host.
 294  *
 295  *   This preserves definition of in6_pcbconnect(), while supporting a
 296  *   slightly different version for T/TCP.  (This is more than
 297  *   a bit of a kludge, but cleaning up the internal interfaces would
 298  *   have forced minor changes in every protocol).
 299  */
 300
 301 int
 302 in6_pcbladdr(struct inpcb *inp, struct sockaddr *nam,
 303              struct in6_addr **plocal_addr6, struct thread *td)
 304 {
 305         struct sockaddr_in6 *sin6 = (struct sockaddr_in6 *)nam;
 306         struct ifnet *ifp = NULL;
 307         int error = 0;
 308
 309         if (nam->sa_len != sizeof (*sin6))
 310                 return (EINVAL);
 311         if (sin6->sin6_family != AF_INET6)
 312                 return (EAFNOSUPPORT);
 313         if (sin6->sin6_port == 0)
 314                 return (EADDRNOTAVAIL);
 315
 316         /* KAME hack: embed scopeid */
 317         if (in6_embedscope(&sin6->sin6_addr, sin6, inp, &ifp) != 0)
 318                 return EINVAL;
 319
 320         if (in6_ifaddr) {
 321                 /*
 322                  * If the destination address is UNSPECIFIED addr,
 323                  * use the loopback addr, e.g ::1.
 324                  */
 325                 if (IN6_IS_ADDR_UNSPECIFIED(&sin6->sin6_addr))
 326                         sin6->sin6_addr = kin6addr_loopback;
 327         }
 328         {
 329                 /*
 330                  * XXX: in6_selectsrc might replace the bound local address
 331                  * with the address specified by setsockopt(IPV6_PKTINFO).
 332                  * Is it the intended behavior?
 333                  */
 334                 *plocal_addr6 = in6_selectsrc(sin6, inp->in6p_outputopts,
 335                                               inp->in6p_moptions,
 336                                               &inp->in6p_route,
 337                                               &inp->in6p_laddr, &error, td);
 338                 if (*plocal_addr6 == 0) {
 339                         if (error == 0)
 340                                 error = EADDRNOTAVAIL;
 341                         return (error);
 342                 }
 343                 /*
 344                  * Don't do pcblookup call here; return interface in
 345                  * plocal_addr6
 346                  * and exit to caller, that will do the lookup.
 347                  */
 348         }
 349
 350         if (inp->in6p_route.ro_rt)
 351                 ifp = inp->in6p_route.ro_rt->rt_ifp;
 352
 353         return (0);
 354 }
 355
 356 /*
 357  * Outer subroutine:
 358  * Connect from a socket to a specified address.
 359  * Both address and port must be specified in argument sin.
 360  * If don't have a local address for this socket yet,
 361  * then pick one.
 362  */
 363 int
 364 in6_pcbconnect(struct inpcb *inp, struct sockaddr *nam, struct thread *td)
 365 {
 366         struct in6_addr *addr6;
 367         struct sockaddr_in6 *sin6 = (struct sockaddr_in6 *)nam;
 368         int error;
 369
 370         /*
 371          * Call inner routine, to assign local interface address.
 372          * in6_pcbladdr() may automatically fill in sin6_scope_id.
 373          */
 374         if ((error = in6_pcbladdr(inp, nam, &addr6, td)) != 0)
 375                 return (error);
 376
 377         if (in6_pcblookup_hash(inp->inp_cpcbinfo, &sin6->sin6_addr,
 378                                sin6->sin6_port,
 379                               IN6_IS_ADDR_UNSPECIFIED(&inp->in6p_laddr)
 380                               ? addr6 : &inp->in6p_laddr,
 381                               inp->inp_lport, 0, NULL) != NULL) {
 382                 return (EADDRINUSE);
 383         }
 384         if (IN6_IS_ADDR_UNSPECIFIED(&inp->in6p_laddr)) {
 385                 if (inp->inp_lport == 0) {
 386                         error = in6_pcbbind(inp, (struct sockaddr *)0, td);
 387                         if (error)
 388                                 return (error);
 389                 }
 390                 inp->in6p_laddr = *addr6;
 391         }
 392         inp->in6p_faddr = sin6->sin6_addr;
 393         inp->inp_fport = sin6->sin6_port;
 394         /* update flowinfo - draft-itojun-ipv6-flowlabel-api-00 */
 395         inp->in6p_flowinfo &= ~IPV6_FLOWLABEL_MASK;
 396         if (inp->in6p_flags & IN6P_AUTOFLOWLABEL)
 397                 inp->in6p_flowinfo |=
 398                     (htonl(ip6_flow_seq++) & IPV6_FLOWLABEL_MASK);
 399
 400         in_pcbinsconnhash(inp);
 401         return (0);
 402 }
 403
 404 #if 0
 405 /*
 406  * Return an IPv6 address, which is the most appropriate for given
 407  * destination and user specified options.
 408  * If necessary, this function lookups the routing table and return
 409  * an entry to the caller for later use.
 410  */
 411 struct in6_addr *
 412 in6_selectsrc(struct sockaddr_in6 *dstsock, struct ip6_pktopts *opts,
 413               struct ip6_moptions *mopts, struct route_in6 *ro,
 414               struct in6_addr *laddr, int *errorp, struct thread *td)
 415 {
 416         struct sockaddr_in6 jsin6;
 417         struct ucred *cred = NULL;
 418         struct in6_addr *dst;
 419         struct in6_ifaddr *ia6 = 0;
 420         struct in6_pktinfo *pi = NULL;
 421         int jailed = 0;
 422
 423         if (td && td->td_proc && td->td_proc->p_ucred)
 424                 cred = td->td_proc->p_ucred;
 425         if (cred && cred->cr_prison)
 426                 jailed = 1;
 427         jsin6.sin6_family = AF_INET6;
 428         dst = &dstsock->sin6_addr;
 429         *errorp = 0;
 430
 431         /*
 432          * If the source address is explicitly specified by the caller,
 433          * use it.
 434          */
 435         if (opts && (pi = opts->ip6po_pktinfo) &&
 436             !IN6_IS_ADDR_UNSPECIFIED(&pi->ipi6_addr)) {
 437                 jsin6.sin6_addr = pi->ipi6_addr;
 438                 if (jailed && !jailed_ip(cred->cr_prison,
 439                     (struct sockaddr *)&jsin6)) {
 440                         return(0);
 441                 } else {
 442                         return (&pi->ipi6_addr);
 443                 }
 444         }
 445
 446         /*
 447          * If the source address is not specified but the socket(if any)
 448          * is already bound, use the bound address.
 449          */
 450         if (laddr && !IN6_IS_ADDR_UNSPECIFIED(laddr)) {
 451                 jsin6.sin6_addr = *laddr;
 452                 if (jailed && !jailed_ip(cred->cr_prison,
 453                     (struct sockaddr *)&jsin6)) {
 454                         return(0);
 455                 } else {
 456                         return (laddr);
 457                 }
 458         }
 459
 460         /*
 461          * If the caller doesn't specify the source address but
 462          * the outgoing interface, use an address associated with
 463          * the interface.
 464          */
 465         if (pi && pi->ipi6_ifindex) {
 466                 /* XXX boundary check is assumed to be already done. */
 467                 ia6 = in6_ifawithscope(ifindex2ifnet[pi->ipi6_ifindex],
 468                                        dst);
 469
 470                 if (ia6 && jailed) {
 471                         jsin6.sin6_addr = (&ia6->ia_addr)->sin6_addr;
 472                         if (!jailed_ip(cred->cr_prison,
 473                                 (struct sockaddr *)&jsin6))
 474                                 ia6 = 0;
 475                 }
 476
 477                 if (ia6 == 0) {
 478                         *errorp = EADDRNOTAVAIL;
 479                         return (0);
 480                 }
 481                 return (&satosin6(&ia6->ia_addr)->sin6_addr);
 482         }
 483
 484         /*
 485          * If the destination address is a link-local unicast address or
 486          * a multicast address, and if the outgoing interface is specified
 487          * by the sin6_scope_id filed, use an address associated with the
 488          * interface.
 489          * XXX: We're now trying to define more specific semantics of
 490          *      sin6_scope_id field, so this part will be rewritten in
 491          *      the near future.
 492          */
 493         if ((IN6_IS_ADDR_LINKLOCAL(dst) || IN6_IS_ADDR_MULTICAST(dst)) &&
 494             dstsock->sin6_scope_id) {
 495                 /*
 496                  * I'm not sure if boundary check for scope_id is done
 497                  * somewhere...
 498                  */
 499                 if (dstsock->sin6_scope_id < 0 ||
 500                     if_index < dstsock->sin6_scope_id) {
 501                         *errorp = ENXIO; /* XXX: better error? */
 502                         return (0);
 503                 }
 504                 ia6 = in6_ifawithscope(ifindex2ifnet[dstsock->sin6_scope_id],
 505                                        dst);
 506
 507                 if (ia6 && jailed) {
 508                         jsin6.sin6_addr = (&ia6->ia_addr)->sin6_addr;
 509                         if (!jailed_ip(cred->cr_prison,
 510                                 (struct sockaddr *)&jsin6))
 511                                 ia6 = 0;
 512                 }
 513
 514                 if (ia6 == 0) {
 515                         *errorp = EADDRNOTAVAIL;
 516                         return (0);
 517                 }
 518                 return (&satosin6(&ia6->ia_addr)->sin6_addr);
 519         }
 520
 521         /*
 522          * If the destination address is a multicast address and
 523          * the outgoing interface for the address is specified
 524          * by the caller, use an address associated with the interface.
 525          * There is a sanity check here; if the destination has node-local
 526          * scope, the outgoing interfacde should be a loopback address.
 527          * Even if the outgoing interface is not specified, we also
 528          * choose a loopback interface as the outgoing interface.
 529          */
 530         if (!jailed && IN6_IS_ADDR_MULTICAST(dst)) {
 531                 struct ifnet *ifp = mopts ? mopts->im6o_multicast_ifp : NULL;
 532
 533                 if (ifp == NULL && IN6_IS_ADDR_MC_NODELOCAL(dst)) {
 534                         ifp = &loif[0];
 535                 }
 536
 537                 if (ifp) {
 538                         ia6 = in6_ifawithscope(ifp, dst);
 539                         if (ia6 == 0) {
 540                                 *errorp = EADDRNOTAVAIL;
 541                                 return (0);
 542                         }
 543                         return (&ia6->ia_addr.sin6_addr);
 544                 }
 545         }
 546
 547         /*
 548          * If the next hop address for the packet is specified
 549          * by caller, use an address associated with the route
 550          * to the next hop.
 551          */
 552         {
 553                 struct sockaddr_in6 *sin6_next;
 554                 struct rtentry *rt;
 555
 556                 if (opts && opts->ip6po_nexthop) {
 557                         sin6_next = satosin6(opts->ip6po_nexthop);
 558                         rt = nd6_lookup(&sin6_next->sin6_addr, 1, NULL);
 559                         if (rt) {
 560                                 ia6 = in6_ifawithscope(rt->rt_ifp, dst);
 561                                 if (ia6 == 0)
 562                                         ia6 = ifatoia6(rt->rt_ifa);
 563                         }
 564                         if (ia6 && jailed) {
 565                                 jsin6.sin6_addr = (&ia6->ia_addr)->sin6_addr;
 566                                 if (!jailed_ip(cred->cr_prison,
 567                                         (struct sockaddr *)&jsin6))
 568                                         ia6 = 0;
 569                         }
 570
 571                         if (ia6 == 0) {
 572                                 *errorp = EADDRNOTAVAIL;
 573                                 return (0);
 574                         }
 575                         return (&satosin6(&ia6->ia_addr)->sin6_addr);
 576                 }
 577         }
 578
 579         /*
 580          * If route is known or can be allocated now,
 581          * our src addr is taken from the i/f, else punt.
 582          */
 583         if (ro) {
 584                 if (ro->ro_rt &&
 585                     !IN6_ARE_ADDR_EQUAL(&satosin6(&ro->ro_dst)->sin6_addr, dst)) {
 586                         RTFREE(ro->ro_rt);
 587                         ro->ro_rt = NULL;
 588                 }
 589                 if (ro->ro_rt == NULL || ro->ro_rt->rt_ifp == NULL) {
 590                         struct sockaddr_in6 *dst6;
 591
 592                         /* No route yet, so try to acquire one */
 593                         bzero(&ro->ro_dst, sizeof(struct sockaddr_in6));
 594                         dst6 = &ro->ro_dst;
 595                         dst6->sin6_family = AF_INET6;
 596                         dst6->sin6_len = sizeof(struct sockaddr_in6);
 597                         dst6->sin6_addr = *dst;
 598                         if (!jailed && IN6_IS_ADDR_MULTICAST(dst)) {
 599                                 ro->ro_rt =
 600                                   rtpurelookup((struct sockaddr *)&ro->ro_dst);
 601                         } else {
 602                                 rtalloc((struct route *)ro);
 603                         }
 604                 }
 605
 606                 /*
 607                  * in_pcbconnect() checks out IFF_LOOPBACK to skip using
 608                  * the address. But we don't know why it does so.
 609                  * It is necessary to ensure the scope even for lo0
 610                  * so doesn't check out IFF_LOOPBACK.
 611                  */
 612
 613                 if (ro->ro_rt) {
 614                         ia6 = in6_ifawithscope(ro->ro_rt->rt_ifa->ifa_ifp, dst);
 615                         if (ia6 && jailed) {
 616                                 jsin6.sin6_addr = (&ia6->ia_addr)->sin6_addr;
 617                                 if (!jailed_ip(cred->cr_prison,
 618                                         (struct sockaddr *)&jsin6))
 619                                         ia6 = 0;
 620                         }
 621
 622                         if (ia6 == 0) /* xxx scope error ?*/
 623                                 ia6 = ifatoia6(ro->ro_rt->rt_ifa);
 624
 625                         if (ia6 && jailed) {
 626                                 jsin6.sin6_addr = (&ia6->ia_addr)->sin6_addr;
 627                                 if (!jailed_ip(cred->cr_prison,
 628                                         (struct sockaddr *)&jsin6))
 629                                         ia6 = 0;
 630                         }
 631                 }
 632                 if (ia6 == 0) {
 633                         *errorp = EHOSTUNREACH; /* no route */
 634                         return (0);
 635                 }
 636                 return (&satosin6(&ia6->ia_addr)->sin6_addr);
 637         }
 638
 639         *errorp = EADDRNOTAVAIL;
 640         return (0);
 641 }
 642
 643 /*
 644  * Default hop limit selection. The precedence is as follows:
 645  * 1. Hoplimit valued specified via ioctl.
 646  * 2. (If the outgoing interface is detected) the current
 647  *     hop limit of the interface specified by router advertisement.
 648  * 3. The system default hoplimit.
 649 */
 650 int
 651 in6_selecthlim(struct in6pcb *in6p, struct ifnet *ifp)
 652 {
 653         if (in6p && in6p->in6p_hops >= 0)
 654                 return (in6p->in6p_hops);
 655         else if (ifp)
 656                 return (ND_IFINFO(ifp)->chlim);
 657         else
 658                 return (ip6_defhlim);
 659 }
 660 #endif
 661
 662 void
 663 in6_pcbdisconnect(struct inpcb *inp)
 664 {
 665         bzero((caddr_t)&inp->in6p_faddr, sizeof(inp->in6p_faddr));
 666         inp->inp_fport = 0;
 667         /* clear flowinfo - draft-itojun-ipv6-flowlabel-api-00 */
 668         inp->in6p_flowinfo &= ~IPV6_FLOWLABEL_MASK;
 669         in_pcbremconnhash(inp);
 670         if (inp->inp_socket->so_state & SS_NOFDREF)
 671                 in6_pcbdetach(inp);
 672 }
 673
 674 void
 675 in6_pcbdetach(struct inpcb *inp)
 676 {
 677         struct socket *so = inp->inp_socket;
 678         struct inpcbinfo *ipi = inp->inp_pcbinfo;
 679
 680 #ifdef IPSEC
 681         if (inp->in6p_sp != NULL)
 682                 ipsec6_delete_pcbpolicy(inp);
 683 #endif /* IPSEC */
 684         inp->inp_gencnt = ++ipi->ipi_gencnt;
 685         in_pcbremlists(inp);
 686         so->so_pcb = NULL;
 687         sofree(so);
 688
 689         if (inp->in6p_options)
 690                 m_freem(inp->in6p_options);
 691         ip6_freepcbopts(inp->in6p_outputopts);
 692         ip6_freemoptions(inp->in6p_moptions);
 693         if (inp->in6p_route.ro_rt)
 694                 rtfree(inp->in6p_route.ro_rt);
 695         /* Check and free IPv4 related resources in case of mapped addr */
 696         if (inp->inp_options)
 697                 m_free(inp->inp_options);
 698         ip_freemoptions(inp->inp_moptions);
 699
 700         inp->inp_vflag = 0;
 701         zfree(ipi->ipi_zone, inp);
 702 }
 703
 704 /*
 705  * The calling convention of in6_setsockaddr() and in6_setpeeraddr() was
 706  * modified to match the pru_sockaddr() and pru_peeraddr() entry points
 707  * in struct pr_usrreqs, so that protocols can just reference then directly
 708  * without the need for a wrapper function.  The socket must have a valid
 709  * (i.e., non-nil) PCB, but it should be impossible to get an invalid one
 710  * except through a kernel programming error, so it is acceptable to panic
 711  * (or in this case trap) if the PCB is invalid.  (Actually, we don't trap
 712  * because there actually /is/ a programming error somewhere... XXX)
 713  */
 714 int
 715 in6_setsockaddr(struct socket *so, struct sockaddr **nam)
 716 {
 717         struct inpcb *inp;
 718         struct sockaddr_in6 *sin6;
 719
 720         /*
 721          * Do the malloc first in case it blocks.
 722          */
 723         MALLOC(sin6, struct sockaddr_in6 *, sizeof *sin6, M_SONAME, M_WAITOK);
 724         bzero(sin6, sizeof *sin6);
 725         sin6->sin6_family = AF_INET6;
 726         sin6->sin6_len = sizeof(*sin6);
 727
 728         crit_enter();
 729         inp = so->so_pcb;
 730         if (!inp) {
 731                 crit_exit();
 732                 kfree(sin6, M_SONAME);
 733                 return EINVAL;
 734         }
 735         sin6->sin6_port = inp->inp_lport;
 736         sin6->sin6_addr = inp->in6p_laddr;
 737         crit_exit();
 738         if (IN6_IS_SCOPE_LINKLOCAL(&sin6->sin6_addr))
 739                 sin6->sin6_scope_id = ntohs(sin6->sin6_addr.s6_addr16[1]);
 740         else
 741                 sin6->sin6_scope_id = 0;        /*XXX*/
 742         if (IN6_IS_SCOPE_LINKLOCAL(&sin6->sin6_addr))
 743                 sin6->sin6_addr.s6_addr16[1] = 0;
 744
 745         *nam = (struct sockaddr *)sin6;
 746         return 0;
 747 }
 748
 749 int
 750 in6_setpeeraddr(struct socket *so, struct sockaddr **nam)
 751 {
 752         struct inpcb *inp;
 753         struct sockaddr_in6 *sin6;
 754
 755         /*
 756          * Do the malloc first in case it blocks.
 757          */
 758         MALLOC(sin6, struct sockaddr_in6 *, sizeof(*sin6), M_SONAME, M_WAITOK);
 759         bzero((caddr_t)sin6, sizeof (*sin6));
 760         sin6->sin6_family = AF_INET6;
 761         sin6->sin6_len = sizeof(struct sockaddr_in6);
 762
 763         crit_enter();
 764         inp = so->so_pcb;
 765         if (!inp) {
 766                 crit_exit();
 767                 kfree(sin6, M_SONAME);
 768                 return EINVAL;
 769         }
 770         sin6->sin6_port = inp->inp_fport;
 771         sin6->sin6_addr = inp->in6p_faddr;
 772         crit_exit();
 773         if (IN6_IS_SCOPE_LINKLOCAL(&sin6->sin6_addr))
 774                 sin6->sin6_scope_id = ntohs(sin6->sin6_addr.s6_addr16[1]);
 775         else
 776                 sin6->sin6_scope_id = 0;        /*XXX*/
 777         if (IN6_IS_SCOPE_LINKLOCAL(&sin6->sin6_addr))
 778                 sin6->sin6_addr.s6_addr16[1] = 0;
 779
 780         *nam = (struct sockaddr *)sin6;
 781         return 0;
 782 }
 783
 784 int
 785 in6_mapped_sockaddr(struct socket *so, struct sockaddr **nam)
 786 {
 787         struct  inpcb *inp = so->so_pcb;
 788         int     error;
 789
 790         if (inp == NULL)
 791                 return EINVAL;
 792         if (inp->inp_vflag & INP_IPV4) {
 793                 error = in_setsockaddr(so, nam);
 794                 if (error == 0)
 795                         in6_sin_2_v4mapsin6_in_sock(nam);
 796         } else
 797         /* scope issues will be handled in in6_setsockaddr(). */
 798         error = in6_setsockaddr(so, nam);
 799
 800         return error;
 801 }
 802
 803 int
 804 in6_mapped_peeraddr(struct socket *so, struct sockaddr **nam)
 805 {
 806         struct  inpcb *inp = so->so_pcb;
 807         int     error;
 808
 809         if (inp == NULL)
 810                 return EINVAL;
 811         if (inp->inp_vflag & INP_IPV4) {
 812                 error = in_setpeeraddr(so, nam);
 813                 if (error == 0)
 814                         in6_sin_2_v4mapsin6_in_sock(nam);
 815         } else
 816         /* scope issues will be handled in in6_setpeeraddr(). */
 817         error = in6_setpeeraddr(so, nam);
 818
 819         return error;
 820 }
 821
 822 /*
 823  * Pass some notification to all connections of a protocol
 824  * associated with address dst.  The local address and/or port numbers
 825  * may be specified to limit the search.  The "usual action" will be
 826  * taken, depending on the ctlinput cmd.  The caller must filter any
 827  * cmds that are uninteresting (e.g., no error in the map).
 828  * Call the protocol specific routine (if any) to report
 829  * any errors for each matching socket.
 830  *
 831  * Must be called under crit_enter().
 832  */
 833 void
 834 in6_pcbnotify(struct inpcbhead *head, struct sockaddr *dst, in_port_t fport,
 835               const struct sockaddr *src, in_port_t lport, int cmd, int arg,
 836               void (*notify) (struct inpcb *, int))
 837 {
 838         struct inpcb *inp, *ninp;
 839         struct sockaddr_in6 sa6_src, *sa6_dst;
 840         u_int32_t flowinfo;
 841
 842         if ((unsigned)cmd >= PRC_NCMDS || dst->sa_family != AF_INET6)
 843                 return;
 844
 845         sa6_dst = (struct sockaddr_in6 *)dst;
 846         if (IN6_IS_ADDR_UNSPECIFIED(&sa6_dst->sin6_addr))
 847                 return;
 848
 849         /*
 850          * note that src can be NULL when we get notify by local fragmentation.
 851          */
 852         sa6_src = (src == NULL) ? sa6_any : *(const struct sockaddr_in6 *)src;
 853         flowinfo = sa6_src.sin6_flowinfo;
 854
 855         /*
 856          * Redirects go to all references to the destination,
 857          * and use in6_rtchange to invalidate the route cache.
 858          * Dead host indications: also use in6_rtchange to invalidate
 859          * the cache, and deliver the error to all the sockets.
 860          * Otherwise, if we have knowledge of the local port and address,
 861          * deliver only to that socket.
 862          */
 863         if (PRC_IS_REDIRECT(cmd) || cmd == PRC_HOSTDEAD) {
 864                 fport = 0;
 865                 lport = 0;
 866                 bzero((caddr_t)&sa6_src.sin6_addr, sizeof(sa6_src.sin6_addr));
 867
 868                 if (cmd != PRC_HOSTDEAD)
 869                         notify = in6_rtchange;
 870         }
 871         if (cmd != PRC_MSGSIZE)
 872                 arg = inet6ctlerrmap[cmd];
 873         crit_enter();
 874         for (inp = LIST_FIRST(head); inp != NULL; inp = ninp) {
 875                 ninp = LIST_NEXT(inp, inp_list);
 876
 877                 if (inp->inp_flags & INP_PLACEMARKER)
 878                         continue;
 879
 880                 if ((inp->inp_vflag & INP_IPV6) == 0)
 881                         continue;
 882
 883                 /*
 884                  * Detect if we should notify the error. If no source and
 885                  * destination ports are specifed, but non-zero flowinfo and
 886                  * local address match, notify the error. This is the case
 887                  * when the error is delivered with an encrypted buffer
 888                  * by ESP. Otherwise, just compare addresses and ports
 889                  * as usual.
 890                  */
 891                 if (lport == 0 && fport == 0 && flowinfo &&
 892                     inp->inp_socket != NULL &&
 893                     flowinfo == (inp->in6p_flowinfo & IPV6_FLOWLABEL_MASK) &&
 894                     IN6_ARE_ADDR_EQUAL(&inp->in6p_laddr, &sa6_src.sin6_addr))
 895                         goto do_notify;
 896                 else if (!IN6_ARE_ADDR_EQUAL(&inp->in6p_faddr,
 897                                              &sa6_dst->sin6_addr) ||
 898                          inp->inp_socket == 0 ||
 899                          (lport && inp->inp_lport != lport) ||
 900                          (!IN6_IS_ADDR_UNSPECIFIED(&sa6_src.sin6_addr) &&
 901                           !IN6_ARE_ADDR_EQUAL(&inp->in6p_laddr,
 902                                               &sa6_src.sin6_addr)) ||
 903                          (fport && inp->inp_fport != fport))
 904                         continue;
 905
 906 do_notify:
 907                 if (notify)
 908                         (*notify)(inp, arg);
 909         }
 910         crit_exit();
 911 }
 912
 913 /*
 914  * Lookup a PCB based on the local address and port.
 915  */
 916 struct inpcb *
 917 in6_pcblookup_local(struct inpcbinfo *pcbinfo, struct in6_addr *laddr,
 918                     u_int lport_arg, int wild_okay, struct ucred *cred)
 919 {
 920         struct inpcb *inp;
 921         int matchwild = 3, wildcard;
 922         u_short lport = lport_arg;
 923         struct inpcbporthead *porthash;
 924         struct inpcbport *phd;
 925         struct inpcb *match = NULL;
 926
 927         /*
 928          * Best fit PCB lookup.
 929          *
 930          * First see if this local port is in use by looking on the
 931          * port hash list.
 932          */
 933         porthash = &pcbinfo->porthashbase[INP_PCBPORTHASH(lport,
 934             pcbinfo->porthashmask)];
 935         LIST_FOREACH(phd, porthash, phd_hash) {
 936                 if (phd->phd_port == lport)
 937                         break;
 938         }
 939         if (phd != NULL) {
 940                 /*
 941                  * Port is in use by one or more PCBs. Look for best
 942                  * fit.
 943                  */
 944                 LIST_FOREACH(inp, &phd->phd_pcblist, inp_portlist) {
 945                         wildcard = 0;
 946                         if ((inp->inp_vflag & INP_IPV6) == 0)
 947                                 continue;
 948                         if (!IN6_IS_ADDR_UNSPECIFIED(&inp->in6p_faddr))
 949                                 wildcard++;
 950                         if (!IN6_IS_ADDR_UNSPECIFIED(&inp->in6p_laddr)) {
 951                                 if (IN6_IS_ADDR_UNSPECIFIED(laddr))
 952                                         wildcard++;
 953                                 else if (!IN6_ARE_ADDR_EQUAL(
 954                                         &inp->in6p_laddr, laddr))
 955                                         continue;
 956                         } else {
 957                                 if (!IN6_IS_ADDR_UNSPECIFIED(laddr))
 958                                         wildcard++;
 959                         }
 960                         if (wildcard && !wild_okay)
 961                                 continue;
 962                         if (wildcard < matchwild &&
 963                             (cred == NULL ||
 964                              cred->cr_prison ==
 965                                         inp->inp_socket->so_cred->cr_prison)) {
 966                                 match = inp;
 967                                 matchwild = wildcard;
 968                                 if (wildcard == 0)
 969                                         break;
 970                                 else
 971                                         matchwild = wildcard;
 972                         }
 973                 }
 974         }
 975         return (match);
 976 }
 977
 978 void
 979 in6_pcbpurgeif0(struct in6pcb *head, struct ifnet *ifp)
 980 {
 981         struct in6pcb *in6p;
 982         struct ip6_moptions *im6o;
 983         struct in6_multi_mship *imm, *nimm;
 984
 985         for (in6p = head; in6p != NULL; in6p = LIST_NEXT(in6p, inp_list)) {
 986                 if (in6p->in6p_flags & INP_PLACEMARKER)
 987                         continue;
 988                 im6o = in6p->in6p_moptions;
 989                 if ((in6p->inp_vflag & INP_IPV6) &&
 990                     im6o) {
 991                         /*
 992                          * Unselect the outgoing interface if it is being
 993                          * detached.
 994                          */
 995                         if (im6o->im6o_multicast_ifp == ifp)
 996                                 im6o->im6o_multicast_ifp = NULL;
 997
 998                         /*
 999                          * Drop multicast group membership if we joined
1000                          * through the interface being detached.
1001                          * XXX controversial - is it really legal for kernel
1002                          * to force this?
1003                          */
1004                         for (imm = im6o->im6o_memberships.lh_first;
1005                              imm != NULL; imm = nimm) {
1006                                 nimm = imm->i6mm_chain.le_next;
1007                                 if (imm->i6mm_maddr->in6m_ifp == ifp) {
1008                                         LIST_REMOVE(imm, i6mm_chain);
1009                                         in6_delmulti(imm->i6mm_maddr);
1010                                         kfree(imm, M_IPMADDR);
1011                                 }
1012                         }
1013                 }
1014         }
1015 }
1016
1017 /*
1018  * Check for alternatives when higher level complains
1019  * about service problems.  For now, invalidate cached
1020  * routing information.  If the route was created dynamically
1021  * (by a redirect), time to try a default gateway again.
1022  */
1023 void
1024 in6_losing(struct inpcb *in6p)
1025 {
1026         struct rtentry *rt;
1027         struct rt_addrinfo info;
1028
1029         if ((rt = in6p->in6p_route.ro_rt) != NULL) {
1030                 bzero((caddr_t)&info, sizeof(info));
1031                 info.rti_flags = rt->rt_flags;
1032                 info.rti_info[RTAX_DST] = rt_key(rt);
1033                 info.rti_info[RTAX_GATEWAY] = rt->rt_gateway;
1034                 info.rti_info[RTAX_NETMASK] = rt_mask(rt);
1035                 rt_missmsg(RTM_LOSING, &info, rt->rt_flags, 0);
1036                 if (rt->rt_flags & RTF_DYNAMIC)
1037                         rtrequest1_global(RTM_DELETE, &info, NULL, NULL);
1038                 in6p->in6p_route.ro_rt = NULL;
1039                 rtfree(rt);
1040                 /*
1041                  * A new route can be allocated
1042                  * the next time output is attempted.
1043                  */
1044         }
1045 }
1046
1047 /*
1048  * After a routing change, flush old routing
1049  * and allocate a (hopefully) better one.
1050  */
1051 void
1052 in6_rtchange(struct inpcb *inp, int error)
1053 {
1054         if (inp->in6p_route.ro_rt) {
1055                 rtfree(inp->in6p_route.ro_rt);
1056                 inp->in6p_route.ro_rt = 0;
1057                 /*
1058                  * A new route can be allocated the next time
1059                  * output is attempted.
1060                  */
1061         }
1062 }
1063
1064 /*
1065  * Lookup PCB in hash list.
1066  */
1067 struct inpcb *
1068 in6_pcblookup_hash(struct inpcbinfo *pcbinfo, struct in6_addr *faddr,
1069                    u_int fport_arg, struct in6_addr *laddr, u_int lport_arg,
1070                    int wildcard, struct ifnet *ifp)
1071 {
1072         struct inpcbhead *head;
1073         struct inpcb *inp;
1074         struct inpcb *jinp = NULL;
1075         u_short fport = fport_arg, lport = lport_arg;
1076         int faith;
1077
1078         if (faithprefix_p != NULL)
1079                 faith = (*faithprefix_p)(laddr);
1080         else
1081                 faith = 0;
1082
1083         /*
1084          * First look for an exact match.
1085          */
1086         head = &pcbinfo->hashbase[INP_PCBCONNHASH(faddr->s6_addr32[3] /* XXX */,
1087                                               fport,
1088                                               laddr->s6_addr32[3], /* XXX JH */
1089                                               lport,
1090                                               pcbinfo->hashmask)];
1091         LIST_FOREACH(inp, head, inp_hash) {
1092                 if ((inp->inp_vflag & INP_IPV6) == 0)
1093                         continue;
1094                 if (IN6_ARE_ADDR_EQUAL(&inp->in6p_faddr, faddr) &&
1095                     IN6_ARE_ADDR_EQUAL(&inp->in6p_laddr, laddr) &&
1096                     inp->inp_fport == fport &&
1097                     inp->inp_lport == lport) {
1098                         /*
1099                          * Found.
1100                          */
1101                         if (inp->inp_socket == NULL ||
1102                         inp->inp_socket->so_cred->cr_prison == NULL) {
1103                                 return (inp);
1104                         } else {
1105                                 if  (jinp == NULL)
1106                                         jinp = inp;
1107                         }
1108                 }
1109         }
1110         if (jinp != NULL)
1111                 return(jinp);
1112         if (wildcard) {
1113                 struct inpcontainerhead *chead;
1114                 struct inpcontainer *ic;
1115                 struct inpcb *local_wild = NULL;
1116                 struct inpcb *jinp_wild = NULL;
1117                 struct sockaddr_in6 jsin6;
1118                 struct ucred *cred;
1119
1120                 /*
1121                  * Order of socket selection:
1122                  * 1. non-jailed, non-wild.
1123                  * 2. non-jailed, wild.
1124                  * 3. jailed, non-wild.
1125                  * 4. jailed, wild.
1126                  */
1127                 jsin6.sin6_family = AF_INET6;
1128                 chead = &pcbinfo->wildcardhashbase[INP_PCBWILDCARDHASH(lport,
1129                     pcbinfo->wildcardhashmask)];
1130                 LIST_FOREACH(ic, chead, ic_list) {
1131                         inp = ic->ic_inp;
1132
1133                         if (!(inp->inp_vflag & INP_IPV6))
1134                                 continue;
1135                         if (inp->inp_socket != NULL)
1136                                 cred = inp->inp_socket->so_cred;
1137                         else
1138                                 cred = NULL;
1139
1140                         if (cred != NULL && jailed(cred)) {
1141                                 if (jinp != NULL) {
1142                                         continue;
1143                                 } else {
1144                                         jsin6.sin6_addr = *laddr;
1145                                         if (!jailed_ip(cred->cr_prison,
1146                                             (struct sockaddr *)&jsin6))
1147                                                 continue;
1148                                 }
1149                         }
1150                         if (IN6_IS_ADDR_UNSPECIFIED(&inp->in6p_faddr) &&
1151                             inp->inp_lport == lport) {
1152                                 if (faith && (inp->inp_flags & INP_FAITH) == 0)
1153                                         continue;
1154                                 if (IN6_ARE_ADDR_EQUAL(&inp->in6p_laddr,
1155                                                        laddr)) {
1156                                         if (cred != NULL && jailed(cred))
1157                                                 jinp = inp;
1158                                         else
1159                                                 return (inp);
1160                                 } else if (IN6_IS_ADDR_UNSPECIFIED(&inp->in6p_laddr)) {
1161                                         if (cred != NULL && jailed(cred))
1162                                                 jinp_wild = inp;
1163                                         else
1164                                                 local_wild = inp;
1165                                 }
1166                         }
1167                 }
1168                 if (local_wild != NULL)
1169                         return (local_wild);
1170                 if (jinp != NULL)
1171                         return (jinp);
1172                 return (jinp_wild);
1173         }
1174
1175         /*
1176          * Not found.
1177          */
1178         return (NULL);
1179 }
1180
1181 void
1182 init_sin6(struct sockaddr_in6 *sin6, struct mbuf *m)
1183 {
1184         struct ip6_hdr *ip;
1185
1186         ip = mtod(m, struct ip6_hdr *);
1187         bzero(sin6, sizeof(*sin6));
1188         sin6->sin6_len = sizeof(*sin6);
1189         sin6->sin6_family = AF_INET6;
1190         sin6->sin6_addr = ip->ip6_src;
1191         if (IN6_IS_SCOPE_LINKLOCAL(&sin6->sin6_addr))
1192                 sin6->sin6_addr.s6_addr16[1] = 0;
1193         sin6->sin6_scope_id =
1194                 (m->m_pkthdr.rcvif && IN6_IS_SCOPE_LINKLOCAL(&sin6->sin6_addr))
1195                 ? m->m_pkthdr.rcvif->if_index : 0;
1196
1197         return;
1198 }