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