sys/netinet6/in6.c

   1 /*-
   2  * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project.
   3  * All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that the following conditions
   7  * are met:
   8  * 1. Redistributions of source code must retain the above copyright
   9  *    notice, this list of conditions and the following disclaimer.
  10  * 2. Redistributions in binary form must reproduce the above copyright
  11  *    notice, this list of conditions and the following disclaimer in the
  12  *    documentation and/or other materials provided with the distribution.
  13  * 3. Neither the name of the project nor the names of its contributors
  14  *    may be used to endorse or promote products derived from this software
  15  *    without specific prior written permission.
  16  *
  17  * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
  18  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  19  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  20  * ARE DISCLAIMED.  IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
  21  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  22  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  23  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  24  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  25  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  26  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  27  * SUCH DAMAGE.
  28  *
  29  *      $KAME: in6.c,v 1.259 2002/01/21 11:37:50 keiichi Exp $
  30  */
  31
  32 /*-
  33  * Copyright (c) 1982, 1986, 1991, 1993
  34  *      The Regents of the University of California.  All rights reserved.
  35  *
  36  * Redistribution and use in source and binary forms, with or without
  37  * modification, are permitted provided that the following conditions
  38  * are met:
  39  * 1. Redistributions of source code must retain the above copyright
  40  *    notice, this list of conditions and the following disclaimer.
  41  * 2. Redistributions in binary form must reproduce the above copyright
  42  *    notice, this list of conditions and the following disclaimer in the
  43  *    documentation and/or other materials provided with the distribution.
  44  * 4. Neither the name of the University nor the names of its contributors
  45  *    may be used to endorse or promote products derived from this software
  46  *    without specific prior written permission.
  47  *
  48  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
  49  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  50  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  51  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
  52  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  53  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  54  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  55  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  56  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  57  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  58  * SUCH DAMAGE.
  59  *
  60  *      @(#)in.c        8.2 (Berkeley) 11/15/93
  61  */
  62
  63 #include <sys/cdefs.h>
  64 __FBSDID("$FreeBSD$");
  65
  66 #include "opt_compat.h"
  67 #include "opt_inet.h"
  68 #include "opt_inet6.h"
  69
  70 #include <sys/param.h>
  71 #include <sys/errno.h>
  72 #include <sys/jail.h>
  73 #include <sys/malloc.h>
  74 #include <sys/socket.h>
  75 #include <sys/socketvar.h>
  76 #include <sys/sockio.h>
  77 #include <sys/systm.h>
  78 #include <sys/priv.h>
  79 #include <sys/proc.h>
  80 #include <sys/time.h>
  81 #include <sys/kernel.h>
  82 #include <sys/syslog.h>
  83
  84 #include <net/if.h>
  85 #include <net/if_var.h>
  86 #include <net/if_types.h>
  87 #include <net/route.h>
  88 #include <net/if_dl.h>
  89 #include <net/vnet.h>
  90
  91 #include <netinet/in.h>
  92 #include <netinet/in_var.h>
  93 #include <net/if_llatbl.h>
  94 #include <netinet/if_ether.h>
  95 #include <netinet/in_systm.h>
  96 #include <netinet/ip.h>
  97 #include <netinet/in_pcb.h>
  98 #include <netinet/ip_carp.h>
  99
 100 #include <netinet/ip6.h>
 101 #include <netinet6/ip6_var.h>
 102 #include <netinet6/nd6.h>
 103 #include <netinet6/mld6_var.h>
 104 #include <netinet6/ip6_mroute.h>
 105 #include <netinet6/in6_ifattach.h>
 106 #include <netinet6/scope6_var.h>
 107 #include <netinet6/in6_pcb.h>
 108
 109 VNET_DECLARE(int, icmp6_nodeinfo_oldmcprefix);
 110 #define V_icmp6_nodeinfo_oldmcprefix    VNET(icmp6_nodeinfo_oldmcprefix)
 111
 112 /*
 113  * Definitions of some costant IP6 addresses.
 114  */
 115 const struct in6_addr in6addr_any = IN6ADDR_ANY_INIT;
 116 const struct in6_addr in6addr_loopback = IN6ADDR_LOOPBACK_INIT;
 117 const struct in6_addr in6addr_nodelocal_allnodes =
 118         IN6ADDR_NODELOCAL_ALLNODES_INIT;
 119 const struct in6_addr in6addr_linklocal_allnodes =
 120         IN6ADDR_LINKLOCAL_ALLNODES_INIT;
 121 const struct in6_addr in6addr_linklocal_allrouters =
 122         IN6ADDR_LINKLOCAL_ALLROUTERS_INIT;
 123 const struct in6_addr in6addr_linklocal_allv2routers =
 124         IN6ADDR_LINKLOCAL_ALLV2ROUTERS_INIT;
 125
 126 const struct in6_addr in6mask0 = IN6MASK0;
 127 const struct in6_addr in6mask32 = IN6MASK32;
 128 const struct in6_addr in6mask64 = IN6MASK64;
 129 const struct in6_addr in6mask96 = IN6MASK96;
 130 const struct in6_addr in6mask128 = IN6MASK128;
 131
 132 const struct sockaddr_in6 sa6_any =
 133         { sizeof(sa6_any), AF_INET6, 0, 0, IN6ADDR_ANY_INIT, 0 };
 134
 135 static int in6_lifaddr_ioctl(struct socket *, u_long, caddr_t,
 136         struct ifnet *, struct thread *);
 137 static int in6_ifinit(struct ifnet *, struct in6_ifaddr *,
 138         struct sockaddr_in6 *, int);
 139 static void in6_unlink_ifa(struct in6_ifaddr *, struct ifnet *);
 140
 141 int     (*faithprefix_p)(struct in6_addr *);
 142
 143 #define ifa2ia6(ifa)    ((struct in6_ifaddr *)(ifa))
 144 #define ia62ifa(ia6)    (&((ia6)->ia_ifa))
 145
 146 void
 147 in6_ifaddloop(struct ifaddr *ifa)
 148 {
 149         struct sockaddr_dl gateway;
 150         struct sockaddr_in6 mask, addr;
 151         struct rtentry rt;
 152         struct in6_ifaddr *ia;
 153         struct ifnet *ifp;
 154         struct llentry *ln;
 155
 156         ia = ifa2ia6(ifa);
 157         ifp = ifa->ifa_ifp;
 158         /*
 159          * initialize for rtmsg generation
 160          */
 161         bzero(&gateway, sizeof(gateway));
 162         gateway.sdl_len = sizeof(gateway);
 163         gateway.sdl_family = AF_LINK;
 164         if (nd6_need_cache(ifp) != 0) {
 165                 IF_AFDATA_LOCK(ifp);
 166                 ifa->ifa_rtrequest = nd6_rtrequest;
 167                 ln = lla_lookup(LLTABLE6(ifp), (LLE_CREATE | LLE_IFADDR |
 168                     LLE_EXCLUSIVE), (struct sockaddr *)&ia->ia_addr);
 169                 IF_AFDATA_UNLOCK(ifp);
 170                 if (ln != NULL) {
 171                         ln->la_expire = 0;  /* for IPv6 this means permanent */
 172                         ln->ln_state = ND6_LLINFO_REACHABLE;
 173
 174                         gateway.sdl_alen = 6;
 175                         memcpy(gateway.sdl_data, &ln->ll_addr.mac_aligned,
 176                             sizeof(ln->ll_addr));
 177                         LLE_WUNLOCK(ln);
 178                 }
 179         }
 180         bzero(&rt, sizeof(rt));
 181         rt.rt_gateway = (struct sockaddr *)&gateway;
 182         memcpy(&mask, &ia->ia_prefixmask, sizeof(ia->ia_prefixmask));
 183         memcpy(&addr, &ia->ia_addr, sizeof(ia->ia_addr));
 184         rt_mask(&rt) = (struct sockaddr *)&mask;
 185         rt_key(&rt) = (struct sockaddr *)&addr;
 186         rt.rt_flags = RTF_UP | RTF_HOST | RTF_STATIC;
 187         /* Announce arrival of local address to all FIBs. */
 188         rt_newaddrmsg(RTM_ADD, ifa, 0, &rt);
 189 }
 190
 191 void
 192 in6_ifremloop(struct ifaddr *ifa)
 193 {
 194         struct sockaddr_dl gateway;
 195         struct sockaddr_in6 mask, addr;
 196         struct rtentry rt0;
 197         struct in6_ifaddr *ia;
 198         struct ifnet *ifp;
 199
 200         ia = ifa2ia6(ifa);
 201         ifp = ifa->ifa_ifp;
 202         memcpy(&addr, &ia->ia_addr, sizeof(ia->ia_addr));
 203         memcpy(&mask, &ia->ia_prefixmask, sizeof(ia->ia_prefixmask));
 204         lltable_prefix_free(AF_INET6, (struct sockaddr *)&addr,
 205                     (struct sockaddr *)&mask, LLE_STATIC);
 206
 207         /*
 208          * initialize for rtmsg generation
 209          */
 210         bzero(&gateway, sizeof(gateway));
 211         gateway.sdl_len = sizeof(gateway);
 212         gateway.sdl_family = AF_LINK;
 213         gateway.sdl_nlen = 0;
 214         gateway.sdl_alen = ifp->if_addrlen;
 215         bzero(&rt0, sizeof(rt0));
 216         rt0.rt_gateway = (struct sockaddr *)&gateway;
 217         rt_mask(&rt0) = (struct sockaddr *)&mask;
 218         rt_key(&rt0) = (struct sockaddr *)&addr;
 219         rt0.rt_flags = RTF_HOST | RTF_STATIC;
 220         /* Announce removal of local address to all FIBs. */
 221         rt_newaddrmsg(RTM_DELETE, ifa, 0, &rt0);
 222 }
 223
 224 int
 225 in6_mask2len(struct in6_addr *mask, u_char *lim0)
 226 {
 227         int x = 0, y;
 228         u_char *lim = lim0, *p;
 229
 230         /* ignore the scope_id part */
 231         if (lim0 == NULL || lim0 - (u_char *)mask > sizeof(*mask))
 232                 lim = (u_char *)mask + sizeof(*mask);
 233         for (p = (u_char *)mask; p < lim; x++, p++) {
 234                 if (*p != 0xff)
 235                         break;
 236         }
 237         y = 0;
 238         if (p < lim) {
 239                 for (y = 0; y < 8; y++) {
 240                         if ((*p & (0x80 >> y)) == 0)
 241                                 break;
 242                 }
 243         }
 244
 245         /*
 246          * when the limit pointer is given, do a stricter check on the
 247          * remaining bits.
 248          */
 249         if (p < lim) {
 250                 if (y != 0 && (*p & (0x00ff >> y)) != 0)
 251                         return (-1);
 252                 for (p = p + 1; p < lim; p++)
 253                         if (*p != 0)
 254                                 return (-1);
 255         }
 256
 257         return x * 8 + y;
 258 }
 259
 260 #ifdef COMPAT_FREEBSD32
 261 struct in6_ndifreq32 {
 262         char ifname[IFNAMSIZ];
 263         uint32_t ifindex;
 264 };
 265 #define SIOCGDEFIFACE32_IN6     _IOWR('i', 86, struct in6_ndifreq32)
 266 #endif
 267
 268 int
 269 in6_control(struct socket *so, u_long cmd, caddr_t data,
 270     struct ifnet *ifp, struct thread *td)
 271 {
 272         struct  in6_ifreq *ifr = (struct in6_ifreq *)data;
 273         struct  in6_ifaddr *ia = NULL;
 274         struct  in6_aliasreq *ifra = (struct in6_aliasreq *)data;
 275         struct sockaddr_in6 *sa6;
 276         int carp_attached = 0;
 277         int error;
 278         u_long ocmd = cmd;
 279
 280         /*
 281          * Compat to make pre-10.x ifconfig(8) operable.
 282          */
 283         if (cmd == OSIOCAIFADDR_IN6)
 284                 cmd = SIOCAIFADDR_IN6;
 285
 286         switch (cmd) {
 287         case SIOCGETSGCNT_IN6:
 288         case SIOCGETMIFCNT_IN6:
 289                 /*
 290                  * XXX mrt_ioctl has a 3rd, unused, FIB argument in route.c.
 291                  * We cannot see how that would be needed, so do not adjust the
 292                  * KPI blindly; more likely should clean up the IPv4 variant.
 293                  */
 294                 return (mrt6_ioctl ? mrt6_ioctl(cmd, data) : EOPNOTSUPP);
 295         }
 296
 297         switch (cmd) {
 298         case SIOCAADDRCTL_POLICY:
 299         case SIOCDADDRCTL_POLICY:
 300                 if (td != NULL) {
 301                         error = priv_check(td, PRIV_NETINET_ADDRCTRL6);
 302                         if (error)
 303                                 return (error);
 304                 }
 305                 return (in6_src_ioctl(cmd, data));
 306         }
 307
 308         if (ifp == NULL)
 309                 return (EOPNOTSUPP);
 310
 311         switch (cmd) {
 312         case SIOCSNDFLUSH_IN6:
 313         case SIOCSPFXFLUSH_IN6:
 314         case SIOCSRTRFLUSH_IN6:
 315         case SIOCSDEFIFACE_IN6:
 316         case SIOCSIFINFO_FLAGS:
 317         case SIOCSIFINFO_IN6:
 318                 if (td != NULL) {
 319                         error = priv_check(td, PRIV_NETINET_ND6);
 320                         if (error)
 321                                 return (error);
 322                 }
 323                 /* FALLTHROUGH */
 324         case OSIOCGIFINFO_IN6:
 325         case SIOCGIFINFO_IN6:
 326         case SIOCGDRLST_IN6:
 327         case SIOCGPRLST_IN6:
 328         case SIOCGNBRINFO_IN6:
 329         case SIOCGDEFIFACE_IN6:
 330                 return (nd6_ioctl(cmd, data, ifp));
 331
 332 #ifdef COMPAT_FREEBSD32
 333         case SIOCGDEFIFACE32_IN6:
 334                 {
 335                         struct in6_ndifreq ndif;
 336                         struct in6_ndifreq32 *ndif32;
 337
 338                         error = nd6_ioctl(SIOCGDEFIFACE_IN6, (caddr_t)&ndif,
 339                             ifp);
 340                         if (error)
 341                                 return (error);
 342                         ndif32 = (struct in6_ndifreq32 *)data;
 343                         ndif32->ifindex = ndif.ifindex;
 344                         return (0);
 345                 }
 346 #endif
 347         }
 348
 349         switch (cmd) {
 350         case SIOCSIFPREFIX_IN6:
 351         case SIOCDIFPREFIX_IN6:
 352         case SIOCAIFPREFIX_IN6:
 353         case SIOCCIFPREFIX_IN6:
 354         case SIOCSGIFPREFIX_IN6:
 355         case SIOCGIFPREFIX_IN6:
 356                 log(LOG_NOTICE,
 357                     "prefix ioctls are now invalidated. "
 358                     "please use ifconfig.\n");
 359                 return (EOPNOTSUPP);
 360         }
 361
 362         switch (cmd) {
 363         case SIOCSSCOPE6:
 364                 if (td != NULL) {
 365                         error = priv_check(td, PRIV_NETINET_SCOPE6);
 366                         if (error)
 367                                 return (error);
 368                 }
 369                 /* FALLTHROUGH */
 370         case SIOCGSCOPE6:
 371         case SIOCGSCOPE6DEF:
 372                 return (scope6_ioctl(cmd, data, ifp));
 373         }
 374
 375         switch (cmd) {
 376         case SIOCALIFADDR:
 377                 if (td != NULL) {
 378                         error = priv_check(td, PRIV_NET_ADDIFADDR);
 379                         if (error)
 380                                 return (error);
 381                 }
 382                 return in6_lifaddr_ioctl(so, cmd, data, ifp, td);
 383
 384         case SIOCDLIFADDR:
 385                 if (td != NULL) {
 386                         error = priv_check(td, PRIV_NET_DELIFADDR);
 387                         if (error)
 388                                 return (error);
 389                 }
 390                 /* FALLTHROUGH */
 391         case SIOCGLIFADDR:
 392                 return in6_lifaddr_ioctl(so, cmd, data, ifp, td);
 393         }
 394
 395         /*
 396          * Find address for this interface, if it exists.
 397          *
 398          * In netinet code, we have checked ifra_addr in SIOCSIF*ADDR operation
 399          * only, and used the first interface address as the target of other
 400          * operations (without checking ifra_addr).  This was because netinet
 401          * code/API assumed at most 1 interface address per interface.
 402          * Since IPv6 allows a node to assign multiple addresses
 403          * on a single interface, we almost always look and check the
 404          * presence of ifra_addr, and reject invalid ones here.
 405          * It also decreases duplicated code among SIOC*_IN6 operations.
 406          */
 407         switch (cmd) {
 408         case SIOCAIFADDR_IN6:
 409         case SIOCSIFPHYADDR_IN6:
 410                 sa6 = &ifra->ifra_addr;
 411                 break;
 412         case SIOCSIFADDR_IN6:
 413         case SIOCGIFADDR_IN6:
 414         case SIOCSIFDSTADDR_IN6:
 415         case SIOCSIFNETMASK_IN6:
 416         case SIOCGIFDSTADDR_IN6:
 417         case SIOCGIFNETMASK_IN6:
 418         case SIOCDIFADDR_IN6:
 419         case SIOCGIFPSRCADDR_IN6:
 420         case SIOCGIFPDSTADDR_IN6:
 421         case SIOCGIFAFLAG_IN6:
 422         case SIOCSNDFLUSH_IN6:
 423         case SIOCSPFXFLUSH_IN6:
 424         case SIOCSRTRFLUSH_IN6:
 425         case SIOCGIFALIFETIME_IN6:
 426         case SIOCSIFALIFETIME_IN6:
 427         case SIOCGIFSTAT_IN6:
 428         case SIOCGIFSTAT_ICMP6:
 429                 sa6 = &ifr->ifr_addr;
 430                 break;
 431         case SIOCSIFADDR:
 432         case SIOCSIFBRDADDR:
 433         case SIOCSIFDSTADDR:
 434         case SIOCSIFNETMASK:
 435                 /*
 436                  * Although we should pass any non-INET6 ioctl requests
 437                  * down to driver, we filter some legacy INET requests.
 438                  * Drivers trust SIOCSIFADDR et al to come from an already
 439                  * privileged layer, and do not perform any credentials
 440                  * checks or input validation.
 441                  */
 442                 return (EINVAL);
 443         default:
 444                 sa6 = NULL;
 445                 break;
 446         }
 447         if (sa6 && sa6->sin6_family == AF_INET6) {
 448                 if (sa6->sin6_scope_id != 0)
 449                         error = sa6_embedscope(sa6, 0);
 450                 else
 451                         error = in6_setscope(&sa6->sin6_addr, ifp, NULL);
 452                 if (error != 0)
 453                         return (error);
 454                 if (td != NULL && (error = prison_check_ip6(td->td_ucred,
 455                     &sa6->sin6_addr)) != 0)
 456                         return (error);
 457                 ia = in6ifa_ifpwithaddr(ifp, &sa6->sin6_addr);
 458         } else
 459                 ia = NULL;
 460
 461         switch (cmd) {
 462         case SIOCSIFADDR_IN6:
 463         case SIOCSIFDSTADDR_IN6:
 464         case SIOCSIFNETMASK_IN6:
 465                 /*
 466                  * Since IPv6 allows a node to assign multiple addresses
 467                  * on a single interface, SIOCSIFxxx ioctls are deprecated.
 468                  */
 469                 /* we decided to obsolete this command (20000704) */
 470                 error = EINVAL;
 471                 goto out;
 472
 473         case SIOCDIFADDR_IN6:
 474                 /*
 475                  * for IPv4, we look for existing in_ifaddr here to allow
 476                  * "ifconfig if0 delete" to remove the first IPv4 address on
 477                  * the interface.  For IPv6, as the spec allows multiple
 478                  * interface address from the day one, we consider "remove the
 479                  * first one" semantics to be not preferable.
 480                  */
 481                 if (ia == NULL) {
 482                         error = EADDRNOTAVAIL;
 483                         goto out;
 484                 }
 485                 /* FALLTHROUGH */
 486         case SIOCAIFADDR_IN6:
 487                 /*
 488                  * We always require users to specify a valid IPv6 address for
 489                  * the corresponding operation.
 490                  */
 491                 if (ifra->ifra_addr.sin6_family != AF_INET6 ||
 492                     ifra->ifra_addr.sin6_len != sizeof(struct sockaddr_in6)) {
 493                         error = EAFNOSUPPORT;
 494                         goto out;
 495                 }
 496
 497                 if (td != NULL) {
 498                         error = priv_check(td, (cmd == SIOCDIFADDR_IN6) ?
 499                             PRIV_NET_DELIFADDR : PRIV_NET_ADDIFADDR);
 500                         if (error)
 501                                 goto out;
 502                 }
 503                 /* FALLTHROUGH */
 504         case SIOCGIFSTAT_IN6:
 505         case SIOCGIFSTAT_ICMP6:
 506                 if (ifp->if_afdata[AF_INET6] == NULL) {
 507                         error = EPFNOSUPPORT;
 508                         goto out;
 509                 }
 510                 break;
 511
 512         case SIOCGIFADDR_IN6:
 513                 /* This interface is basically deprecated. use SIOCGIFCONF. */
 514                 /* FALLTHROUGH */
 515         case SIOCGIFAFLAG_IN6:
 516         case SIOCGIFNETMASK_IN6:
 517         case SIOCGIFDSTADDR_IN6:
 518         case SIOCGIFALIFETIME_IN6:
 519                 /* must think again about its semantics */
 520                 if (ia == NULL) {
 521                         error = EADDRNOTAVAIL;
 522                         goto out;
 523                 }
 524                 break;
 525
 526         case SIOCSIFALIFETIME_IN6:
 527             {
 528                 struct in6_addrlifetime *lt;
 529
 530                 if (td != NULL) {
 531                         error = priv_check(td, PRIV_NETINET_ALIFETIME6);
 532                         if (error)
 533                                 goto out;
 534                 }
 535                 if (ia == NULL) {
 536                         error = EADDRNOTAVAIL;
 537                         goto out;
 538                 }
 539                 /* sanity for overflow - beware unsigned */
 540                 lt = &ifr->ifr_ifru.ifru_lifetime;
 541                 if (lt->ia6t_vltime != ND6_INFINITE_LIFETIME &&
 542                     lt->ia6t_vltime + time_uptime < time_uptime) {
 543                         error = EINVAL;
 544                         goto out;
 545                 }
 546                 if (lt->ia6t_pltime != ND6_INFINITE_LIFETIME &&
 547                     lt->ia6t_pltime + time_uptime < time_uptime) {
 548                         error = EINVAL;
 549                         goto out;
 550                 }
 551                 break;
 552             }
 553         }
 554
 555         switch (cmd) {
 556         case SIOCGIFADDR_IN6:
 557                 ifr->ifr_addr = ia->ia_addr;
 558                 if ((error = sa6_recoverscope(&ifr->ifr_addr)) != 0)
 559                         goto out;
 560                 break;
 561
 562         case SIOCGIFDSTADDR_IN6:
 563                 if ((ifp->if_flags & IFF_POINTOPOINT) == 0) {
 564                         error = EINVAL;
 565                         goto out;
 566                 }
 567                 /*
 568                  * XXX: should we check if ifa_dstaddr is NULL and return
 569                  * an error?
 570                  */
 571                 ifr->ifr_dstaddr = ia->ia_dstaddr;
 572                 if ((error = sa6_recoverscope(&ifr->ifr_dstaddr)) != 0)
 573                         goto out;
 574                 break;
 575
 576         case SIOCGIFNETMASK_IN6:
 577                 ifr->ifr_addr = ia->ia_prefixmask;
 578                 break;
 579
 580         case SIOCGIFAFLAG_IN6:
 581                 ifr->ifr_ifru.ifru_flags6 = ia->ia6_flags;
 582                 break;
 583
 584         case SIOCGIFSTAT_IN6:
 585                 COUNTER_ARRAY_COPY(((struct in6_ifextra *)
 586                     ifp->if_afdata[AF_INET6])->in6_ifstat,
 587                     &ifr->ifr_ifru.ifru_stat,
 588                     sizeof(struct in6_ifstat) / sizeof(uint64_t));
 589                 break;
 590
 591         case SIOCGIFSTAT_ICMP6:
 592                 COUNTER_ARRAY_COPY(((struct in6_ifextra *)
 593                     ifp->if_afdata[AF_INET6])->icmp6_ifstat,
 594                     &ifr->ifr_ifru.ifru_icmp6stat,
 595                     sizeof(struct icmp6_ifstat) / sizeof(uint64_t));
 596                 break;
 597
 598         case SIOCGIFALIFETIME_IN6:
 599                 ifr->ifr_ifru.ifru_lifetime = ia->ia6_lifetime;
 600                 if (ia->ia6_lifetime.ia6t_vltime != ND6_INFINITE_LIFETIME) {
 601                         time_t maxexpire;
 602                         struct in6_addrlifetime *retlt =
 603                             &ifr->ifr_ifru.ifru_lifetime;
 604
 605                         /*
 606                          * XXX: adjust expiration time assuming time_t is
 607                          * signed.
 608                          */
 609                         maxexpire = (-1) &
 610                             ~((time_t)1 << ((sizeof(maxexpire) * 8) - 1));
 611                         if (ia->ia6_lifetime.ia6t_vltime <
 612                             maxexpire - ia->ia6_updatetime) {
 613                                 retlt->ia6t_expire = ia->ia6_updatetime +
 614                                     ia->ia6_lifetime.ia6t_vltime;
 615                         } else
 616                                 retlt->ia6t_expire = maxexpire;
 617                 }
 618                 if (ia->ia6_lifetime.ia6t_pltime != ND6_INFINITE_LIFETIME) {
 619                         time_t maxexpire;
 620                         struct in6_addrlifetime *retlt =
 621                             &ifr->ifr_ifru.ifru_lifetime;
 622
 623                         /*
 624                          * XXX: adjust expiration time assuming time_t is
 625                          * signed.
 626                          */
 627                         maxexpire = (-1) &
 628                             ~((time_t)1 << ((sizeof(maxexpire) * 8) - 1));
 629                         if (ia->ia6_lifetime.ia6t_pltime <
 630                             maxexpire - ia->ia6_updatetime) {
 631                                 retlt->ia6t_preferred = ia->ia6_updatetime +
 632                                     ia->ia6_lifetime.ia6t_pltime;
 633                         } else
 634                                 retlt->ia6t_preferred = maxexpire;
 635                 }
 636                 break;
 637
 638         case SIOCSIFALIFETIME_IN6:
 639                 ia->ia6_lifetime = ifr->ifr_ifru.ifru_lifetime;
 640                 /* for sanity */
 641                 if (ia->ia6_lifetime.ia6t_vltime != ND6_INFINITE_LIFETIME) {
 642                         ia->ia6_lifetime.ia6t_expire =
 643                                 time_uptime + ia->ia6_lifetime.ia6t_vltime;
 644                 } else
 645                         ia->ia6_lifetime.ia6t_expire = 0;
 646                 if (ia->ia6_lifetime.ia6t_pltime != ND6_INFINITE_LIFETIME) {
 647                         ia->ia6_lifetime.ia6t_preferred =
 648                                 time_uptime + ia->ia6_lifetime.ia6t_pltime;
 649                 } else
 650                         ia->ia6_lifetime.ia6t_preferred = 0;
 651                 break;
 652
 653         case SIOCAIFADDR_IN6:
 654         {
 655                 int i;
 656                 struct nd_prefixctl pr0;
 657                 struct nd_prefix *pr;
 658
 659                 /*
 660                  * first, make or update the interface address structure,
 661                  * and link it to the list.
 662                  */
 663                 if ((error = in6_update_ifa(ifp, ifra, ia, 0)) != 0)
 664                         goto out;
 665                 if (ia != NULL)
 666                         ifa_free(&ia->ia_ifa);
 667                 if ((ia = in6ifa_ifpwithaddr(ifp, &ifra->ifra_addr.sin6_addr))
 668                     == NULL) {
 669                         /*
 670                          * this can happen when the user specify the 0 valid
 671                          * lifetime.
 672                          */
 673                         break;
 674                 }
 675
 676                 if (cmd == ocmd && ifra->ifra_vhid > 0) {
 677                         if (carp_attach_p != NULL)
 678                                 error = (*carp_attach_p)(&ia->ia_ifa,
 679                                     ifra->ifra_vhid);
 680                         else
 681                                 error = EPROTONOSUPPORT;
 682                         if (error)
 683                                 goto out;
 684                         else
 685                                 carp_attached = 1;
 686                 }
 687
 688                 /*
 689                  * then, make the prefix on-link on the interface.
 690                  * XXX: we'd rather create the prefix before the address, but
 691                  * we need at least one address to install the corresponding
 692                  * interface route, so we configure the address first.
 693                  */
 694
 695                 /*
 696                  * convert mask to prefix length (prefixmask has already
 697                  * been validated in in6_update_ifa().
 698                  */
 699                 bzero(&pr0, sizeof(pr0));
 700                 pr0.ndpr_ifp = ifp;
 701                 pr0.ndpr_plen = in6_mask2len(&ifra->ifra_prefixmask.sin6_addr,
 702                     NULL);
 703                 if (pr0.ndpr_plen == 128) {
 704                         break;  /* we don't need to install a host route. */
 705                 }
 706                 pr0.ndpr_prefix = ifra->ifra_addr;
 707                 /* apply the mask for safety. */
 708                 for (i = 0; i < 4; i++) {
 709                         pr0.ndpr_prefix.sin6_addr.s6_addr32[i] &=
 710                             ifra->ifra_prefixmask.sin6_addr.s6_addr32[i];
 711                 }
 712                 /*
 713                  * XXX: since we don't have an API to set prefix (not address)
 714                  * lifetimes, we just use the same lifetimes as addresses.
 715                  * The (temporarily) installed lifetimes can be overridden by
 716                  * later advertised RAs (when accept_rtadv is non 0), which is
 717                  * an intended behavior.
 718                  */
 719                 pr0.ndpr_raf_onlink = 1; /* should be configurable? */
 720                 pr0.ndpr_raf_auto =
 721                     ((ifra->ifra_flags & IN6_IFF_AUTOCONF) != 0);
 722                 pr0.ndpr_vltime = ifra->ifra_lifetime.ia6t_vltime;
 723                 pr0.ndpr_pltime = ifra->ifra_lifetime.ia6t_pltime;
 724
 725                 /* add the prefix if not yet. */
 726                 if ((pr = nd6_prefix_lookup(&pr0)) == NULL) {
 727                         /*
 728                          * nd6_prelist_add will install the corresponding
 729                          * interface route.
 730                          */
 731                         if ((error = nd6_prelist_add(&pr0, NULL, &pr)) != 0) {
 732                                 if (carp_attached)
 733                                         (*carp_detach_p)(&ia->ia_ifa);
 734                                 goto out;
 735                         }
 736                         if (pr == NULL) {
 737                                 if (carp_attached)
 738                                         (*carp_detach_p)(&ia->ia_ifa);
 739                                 log(LOG_ERR, "nd6_prelist_add succeeded but "
 740                                     "no prefix\n");
 741                                 error = EINVAL;
 742                                 goto out;
 743                         }
 744                 }
 745
 746                 /* relate the address to the prefix */
 747                 if (ia->ia6_ndpr == NULL) {
 748                         ia->ia6_ndpr = pr;
 749                         pr->ndpr_refcnt++;
 750
 751                         /*
 752                          * If this is the first autoconf address from the
 753                          * prefix, create a temporary address as well
 754                          * (when required).
 755                          */
 756                         if ((ia->ia6_flags & IN6_IFF_AUTOCONF) &&
 757                             V_ip6_use_tempaddr && pr->ndpr_refcnt == 1) {
 758                                 int e;
 759                                 if ((e = in6_tmpifadd(ia, 1, 0)) != 0) {
 760                                         log(LOG_NOTICE, "in6_control: failed "
 761                                             "to create a temporary address, "
 762                                             "errno=%d\n", e);
 763                                 }
 764                         }
 765                 }
 766
 767                 /*
 768                  * this might affect the status of autoconfigured addresses,
 769                  * that is, this address might make other addresses detached.
 770                  */
 771                 pfxlist_onlink_check();
 772                 if (error == 0 && ia) {
 773                         if (ND_IFINFO(ifp)->flags & ND6_IFF_IFDISABLED) {
 774                                 /*
 775                                  * Try to clear the flag when a new
 776                                  * IPv6 address is added onto an
 777                                  * IFDISABLED interface and it
 778                                  * succeeds.
 779                                  */
 780                                 struct in6_ndireq nd;
 781
 782                                 memset(&nd, 0, sizeof(nd));
 783                                 nd.ndi.flags = ND_IFINFO(ifp)->flags;
 784                                 nd.ndi.flags &= ~ND6_IFF_IFDISABLED;
 785                                 if (nd6_ioctl(SIOCSIFINFO_FLAGS,
 786                                     (caddr_t)&nd, ifp) < 0)
 787                                         log(LOG_NOTICE, "SIOCAIFADDR_IN6: "
 788                                             "SIOCSIFINFO_FLAGS for -ifdisabled "
 789                                             "failed.");
 790                                 /*
 791                                  * Ignore failure of clearing the flag
 792                                  * intentionally.  The failure means
 793                                  * address duplication was detected.
 794                                  */
 795                         }
 796                         EVENTHANDLER_INVOKE(ifaddr_event, ifp);
 797                 }
 798                 break;
 799         }
 800
 801         case SIOCDIFADDR_IN6:
 802         {
 803                 struct nd_prefix *pr;
 804
 805                 /*
 806                  * If the address being deleted is the only one that owns
 807                  * the corresponding prefix, expire the prefix as well.
 808                  * XXX: theoretically, we don't have to worry about such
 809                  * relationship, since we separate the address management
 810                  * and the prefix management.  We do this, however, to provide
 811                  * as much backward compatibility as possible in terms of
 812                  * the ioctl operation.
 813                  * Note that in6_purgeaddr() will decrement ndpr_refcnt.
 814                  */
 815                 pr = ia->ia6_ndpr;
 816                 in6_purgeaddr(&ia->ia_ifa);
 817                 if (pr && pr->ndpr_refcnt == 0)
 818                         prelist_remove(pr);
 819                 EVENTHANDLER_INVOKE(ifaddr_event, ifp);
 820                 break;
 821         }
 822
 823         default:
 824                 if (ifp->if_ioctl == NULL) {
 825                         error = EOPNOTSUPP;
 826                         goto out;
 827                 }
 828                 error = (*ifp->if_ioctl)(ifp, cmd, data);
 829                 goto out;
 830         }
 831
 832         error = 0;
 833 out:
 834         if (ia != NULL)
 835                 ifa_free(&ia->ia_ifa);
 836         return (error);
 837 }
 838
 839
 840 /*
 841  * Join necessary multicast groups.  Factored out from in6_update_ifa().
 842  * This entire work should only be done once, for the default FIB.
 843  */
 844 static int
 845 in6_update_ifa_join_mc(struct ifnet *ifp, struct in6_aliasreq *ifra,
 846     struct in6_ifaddr *ia, int flags, struct in6_multi **in6m_sol)
 847 {
 848         char ip6buf[INET6_ADDRSTRLEN];
 849         struct sockaddr_in6 mltaddr, mltmask;
 850         struct in6_addr llsol;
 851         struct in6_multi_mship *imm;
 852         struct rtentry *rt;
 853         int delay, error;
 854
 855         KASSERT(in6m_sol != NULL, ("%s: in6m_sol is NULL", __func__));
 856
 857         /* Join solicited multicast addr for new host id. */
 858         bzero(&llsol, sizeof(struct in6_addr));
 859         llsol.s6_addr32[0] = IPV6_ADDR_INT32_MLL;
 860         llsol.s6_addr32[1] = 0;
 861         llsol.s6_addr32[2] = htonl(1);
 862         llsol.s6_addr32[3] = ifra->ifra_addr.sin6_addr.s6_addr32[3];
 863         llsol.s6_addr8[12] = 0xff;
 864         if ((error = in6_setscope(&llsol, ifp, NULL)) != 0) {
 865                 /* XXX: should not happen */
 866                 log(LOG_ERR, "%s: in6_setscope failed\n", __func__);
 867                 goto cleanup;
 868         }
 869         delay = 0;
 870         if ((flags & IN6_IFAUPDATE_DADDELAY)) {
 871                 /*
 872                  * We need a random delay for DAD on the address being
 873                  * configured.  It also means delaying transmission of the
 874                  * corresponding MLD report to avoid report collision.
 875                  * [RFC 4861, Section 6.3.7]
 876                  */
 877                 delay = arc4random() % (MAX_RTR_SOLICITATION_DELAY * hz);
 878         }
 879         imm = in6_joingroup(ifp, &llsol, &error, delay);
 880         if (imm == NULL) {
 881                 nd6log((LOG_WARNING, "%s: addmulti failed for %s on %s "
 882                     "(errno=%d)\n", __func__, ip6_sprintf(ip6buf, &llsol),
 883                     if_name(ifp), error));
 884                 goto cleanup;
 885         }
 886         LIST_INSERT_HEAD(&ia->ia6_memberships, imm, i6mm_chain);
 887         *in6m_sol = imm->i6mm_maddr;
 888
 889         bzero(&mltmask, sizeof(mltmask));
 890         mltmask.sin6_len = sizeof(struct sockaddr_in6);
 891         mltmask.sin6_family = AF_INET6;
 892         mltmask.sin6_addr = in6mask32;
 893 #define MLTMASK_LEN  4  /* mltmask's masklen (=32bit=4octet) */
 894
 895         /*
 896          * Join link-local all-nodes address.
 897          */
 898         bzero(&mltaddr, sizeof(mltaddr));
 899         mltaddr.sin6_len = sizeof(struct sockaddr_in6);
 900         mltaddr.sin6_family = AF_INET6;
 901         mltaddr.sin6_addr = in6addr_linklocal_allnodes;
 902         if ((error = in6_setscope(&mltaddr.sin6_addr, ifp, NULL)) != 0)
 903                 goto cleanup; /* XXX: should not fail */
 904
 905         /*
 906          * XXX: do we really need this automatic routes?  We should probably
 907          * reconsider this stuff.  Most applications actually do not need the
 908          * routes, since they usually specify the outgoing interface.
 909          */
 910         rt = in6_rtalloc1((struct sockaddr *)&mltaddr, 0, 0UL, RT_DEFAULT_FIB);
 911         if (rt != NULL) {
 912                 /* XXX: only works in !SCOPEDROUTING case. */
 913                 if (memcmp(&mltaddr.sin6_addr,
 914                     &((struct sockaddr_in6 *)rt_key(rt))->sin6_addr,
 915                     MLTMASK_LEN)) {
 916                         RTFREE_LOCKED(rt);
 917                         rt = NULL;
 918                 }
 919         }
 920         if (rt == NULL) {
 921                 error = in6_rtrequest(RTM_ADD, (struct sockaddr *)&mltaddr,
 922                     (struct sockaddr *)&ia->ia_addr,
 923                     (struct sockaddr *)&mltmask, RTF_UP,
 924                     (struct rtentry **)0, RT_DEFAULT_FIB);
 925                 if (error)
 926                         goto cleanup;
 927         } else
 928                 RTFREE_LOCKED(rt);
 929
 930         imm = in6_joingroup(ifp, &mltaddr.sin6_addr, &error, 0);
 931         if (imm == NULL) {
 932                 nd6log((LOG_WARNING, "%s: addmulti failed for %s on %s "
 933                     "(errno=%d)\n", __func__, ip6_sprintf(ip6buf,
 934                     &mltaddr.sin6_addr), if_name(ifp), error));
 935                 goto cleanup;
 936         }
 937         LIST_INSERT_HEAD(&ia->ia6_memberships, imm, i6mm_chain);
 938
 939         /*
 940          * Join node information group address.
 941          */
 942         delay = 0;
 943         if ((flags & IN6_IFAUPDATE_DADDELAY)) {
 944                 /*
 945                  * The spec does not say anything about delay for this group,
 946                  * but the same logic should apply.
 947                  */
 948                 delay = arc4random() % (MAX_RTR_SOLICITATION_DELAY * hz);
 949         }
 950         if (in6_nigroup(ifp, NULL, -1, &mltaddr.sin6_addr) == 0) {
 951                 /* XXX jinmei */
 952                 imm = in6_joingroup(ifp, &mltaddr.sin6_addr, &error, delay);
 953                 if (imm == NULL)
 954                         nd6log((LOG_WARNING, "%s: addmulti failed for %s on %s "
 955                             "(errno=%d)\n", __func__, ip6_sprintf(ip6buf,
 956                             &mltaddr.sin6_addr), if_name(ifp), error));
 957                         /* XXX not very fatal, go on... */
 958                 else
 959                         LIST_INSERT_HEAD(&ia->ia6_memberships, imm, i6mm_chain);
 960         }
 961         if (V_icmp6_nodeinfo_oldmcprefix &&
 962              in6_nigroup_oldmcprefix(ifp, NULL, -1, &mltaddr.sin6_addr) == 0) {
 963                 imm = in6_joingroup(ifp, &mltaddr.sin6_addr, &error, delay);
 964                 if (imm == NULL)
 965                         nd6log((LOG_WARNING, "%s: addmulti failed for %s on %s "
 966                             "(errno=%d)\n", __func__, ip6_sprintf(ip6buf,
 967                             &mltaddr.sin6_addr), if_name(ifp), error));
 968                         /* XXX not very fatal, go on... */
 969                 else
 970                         LIST_INSERT_HEAD(&ia->ia6_memberships, imm, i6mm_chain);
 971         }
 972
 973         /*
 974          * Join interface-local all-nodes address.
 975          * (ff01::1%ifN, and ff01::%ifN/32)
 976          */
 977         mltaddr.sin6_addr = in6addr_nodelocal_allnodes;
 978         if ((error = in6_setscope(&mltaddr.sin6_addr, ifp, NULL)) != 0)
 979                 goto cleanup; /* XXX: should not fail */
 980         /* XXX: again, do we really need the route? */
 981         rt = in6_rtalloc1((struct sockaddr *)&mltaddr, 0, 0UL, RT_DEFAULT_FIB);
 982         if (rt != NULL) {
 983                 if (memcmp(&mltaddr.sin6_addr,
 984                     &((struct sockaddr_in6 *)rt_key(rt))->sin6_addr,
 985                     MLTMASK_LEN)) {
 986                         RTFREE_LOCKED(rt);
 987                         rt = NULL;
 988                 }
 989         }
 990         if (rt == NULL) {
 991                 error = in6_rtrequest(RTM_ADD, (struct sockaddr *)&mltaddr,
 992                     (struct sockaddr *)&ia->ia_addr,
 993                     (struct sockaddr *)&mltmask, RTF_UP,
 994                     (struct rtentry **)0, RT_DEFAULT_FIB);
 995                 if (error)
 996                         goto cleanup;
 997         } else
 998                 RTFREE_LOCKED(rt);
 999
1000         imm = in6_joingroup(ifp, &mltaddr.sin6_addr, &error, 0);
1001         if (imm == NULL) {
1002                 nd6log((LOG_WARNING, "%s: addmulti failed for %s on %s "
1003                     "(errno=%d)\n", __func__, ip6_sprintf(ip6buf,
1004                     &mltaddr.sin6_addr), if_name(ifp), error));
1005                 goto cleanup;
1006         }
1007         LIST_INSERT_HEAD(&ia->ia6_memberships, imm, i6mm_chain);
1008 #undef  MLTMASK_LEN
1009
1010 cleanup:
1011         return (error);
1012 }
1013
1014 /*
1015  * Update parameters of an IPv6 interface address.
1016  * If necessary, a new entry is created and linked into address chains.
1017  * This function is separated from in6_control().
1018  */
1019 int
1020 in6_update_ifa(struct ifnet *ifp, struct in6_aliasreq *ifra,
1021     struct in6_ifaddr *ia, int flags)
1022 {
1023         int error = 0, hostIsNew = 0, plen = -1;
1024         struct sockaddr_in6 dst6;
1025         struct in6_addrlifetime *lt;
1026         struct in6_multi *in6m_sol;
1027         int delay;
1028         char ip6buf[INET6_ADDRSTRLEN];
1029
1030         /* Validate parameters */
1031         if (ifp == NULL || ifra == NULL) /* this maybe redundant */
1032                 return (EINVAL);
1033
1034         /*
1035          * The destination address for a p2p link must have a family
1036          * of AF_UNSPEC or AF_INET6.
1037          */
1038         if ((ifp->if_flags & IFF_POINTOPOINT) != 0 &&
1039             ifra->ifra_dstaddr.sin6_family != AF_INET6 &&
1040             ifra->ifra_dstaddr.sin6_family != AF_UNSPEC)
1041                 return (EAFNOSUPPORT);
1042         /*
1043          * validate ifra_prefixmask.  don't check sin6_family, netmask
1044          * does not carry fields other than sin6_len.
1045          */
1046         if (ifra->ifra_prefixmask.sin6_len > sizeof(struct sockaddr_in6))
1047                 return (EINVAL);
1048         /*
1049          * Because the IPv6 address architecture is classless, we require
1050          * users to specify a (non 0) prefix length (mask) for a new address.
1051          * We also require the prefix (when specified) mask is valid, and thus
1052          * reject a non-consecutive mask.
1053          */
1054         if (ia == NULL && ifra->ifra_prefixmask.sin6_len == 0)
1055                 return (EINVAL);
1056         if (ifra->ifra_prefixmask.sin6_len != 0) {
1057                 plen = in6_mask2len(&ifra->ifra_prefixmask.sin6_addr,
1058                     (u_char *)&ifra->ifra_prefixmask +
1059                     ifra->ifra_prefixmask.sin6_len);
1060                 if (plen <= 0)
1061                         return (EINVAL);
1062         } else {
1063                 /*
1064                  * In this case, ia must not be NULL.  We just use its prefix
1065                  * length.
1066                  */
1067                 plen = in6_mask2len(&ia->ia_prefixmask.sin6_addr, NULL);
1068         }
1069         /*
1070          * If the destination address on a p2p interface is specified,
1071          * and the address is a scoped one, validate/set the scope
1072          * zone identifier.
1073          */
1074         dst6 = ifra->ifra_dstaddr;
1075         if ((ifp->if_flags & (IFF_POINTOPOINT|IFF_LOOPBACK)) != 0 &&
1076             (dst6.sin6_family == AF_INET6)) {
1077                 struct in6_addr in6_tmp;
1078                 u_int32_t zoneid;
1079
1080                 in6_tmp = dst6.sin6_addr;
1081                 if (in6_setscope(&in6_tmp, ifp, &zoneid))
1082                         return (EINVAL); /* XXX: should be impossible */
1083
1084                 if (dst6.sin6_scope_id != 0) {
1085                         if (dst6.sin6_scope_id != zoneid)
1086                                 return (EINVAL);
1087                 } else          /* user omit to specify the ID. */
1088                         dst6.sin6_scope_id = zoneid;
1089
1090                 /* convert into the internal form */
1091                 if (sa6_embedscope(&dst6, 0))
1092                         return (EINVAL); /* XXX: should be impossible */
1093         }
1094         /*
1095          * The destination address can be specified only for a p2p or a
1096          * loopback interface.  If specified, the corresponding prefix length
1097          * must be 128.
1098          */
1099         if (ifra->ifra_dstaddr.sin6_family == AF_INET6) {
1100                 if ((ifp->if_flags & (IFF_POINTOPOINT|IFF_LOOPBACK)) == 0) {
1101                         /* XXX: noisy message */
1102                         nd6log((LOG_INFO, "in6_update_ifa: a destination can "
1103                             "be specified for a p2p or a loopback IF only\n"));
1104                         return (EINVAL);
1105                 }
1106                 if (plen != 128) {
1107                         nd6log((LOG_INFO, "in6_update_ifa: prefixlen should "
1108                             "be 128 when dstaddr is specified\n"));
1109                         return (EINVAL);
1110                 }
1111         }
1112         /* lifetime consistency check */
1113         lt = &ifra->ifra_lifetime;
1114         if (lt->ia6t_pltime > lt->ia6t_vltime)
1115                 return (EINVAL);
1116         if (lt->ia6t_vltime == 0) {
1117                 /*
1118                  * the following log might be noisy, but this is a typical
1119                  * configuration mistake or a tool's bug.
1120                  */
1121                 nd6log((LOG_INFO,
1122                     "in6_update_ifa: valid lifetime is 0 for %s\n",
1123                     ip6_sprintf(ip6buf, &ifra->ifra_addr.sin6_addr)));
1124
1125                 if (ia == NULL)
1126                         return (0); /* there's nothing to do */
1127         }
1128
1129         /*
1130          * If this is a new address, allocate a new ifaddr and link it
1131          * into chains.
1132          */
1133         if (ia == NULL) {
1134                 hostIsNew = 1;
1135                 /*
1136                  * When in6_update_ifa() is called in a process of a received
1137                  * RA, it is called under an interrupt context.  So, we should
1138                  * call malloc with M_NOWAIT.
1139                  */
1140                 ia = (struct in6_ifaddr *) malloc(sizeof(*ia), M_IFADDR,
1141                     M_NOWAIT);
1142                 if (ia == NULL)
1143                         return (ENOBUFS);
1144                 bzero((caddr_t)ia, sizeof(*ia));
1145                 ifa_init(&ia->ia_ifa);
1146                 LIST_INIT(&ia->ia6_memberships);
1147                 /* Initialize the address and masks, and put time stamp */
1148                 ia->ia_ifa.ifa_addr = (struct sockaddr *)&ia->ia_addr;
1149                 ia->ia_addr.sin6_family = AF_INET6;
1150                 ia->ia_addr.sin6_len = sizeof(ia->ia_addr);
1151                 ia->ia6_createtime = time_uptime;
1152                 if ((ifp->if_flags & (IFF_POINTOPOINT | IFF_LOOPBACK)) != 0) {
1153                         /*
1154                          * XXX: some functions expect that ifa_dstaddr is not
1155                          * NULL for p2p interfaces.
1156                          */
1157                         ia->ia_ifa.ifa_dstaddr =
1158                             (struct sockaddr *)&ia->ia_dstaddr;
1159                 } else {
1160                         ia->ia_ifa.ifa_dstaddr = NULL;
1161                 }
1162                 ia->ia_ifa.ifa_netmask = (struct sockaddr *)&ia->ia_prefixmask;
1163                 ia->ia_ifp = ifp;
1164                 ifa_ref(&ia->ia_ifa);                   /* if_addrhead */
1165                 IF_ADDR_WLOCK(ifp);
1166                 TAILQ_INSERT_TAIL(&ifp->if_addrhead, &ia->ia_ifa, ifa_link);
1167                 IF_ADDR_WUNLOCK(ifp);
1168
1169                 ifa_ref(&ia->ia_ifa);                   /* in6_ifaddrhead */
1170                 IN6_IFADDR_WLOCK();
1171                 TAILQ_INSERT_TAIL(&V_in6_ifaddrhead, ia, ia_link);
1172                 LIST_INSERT_HEAD(IN6ADDR_HASH(&ifra->ifra_addr.sin6_addr),
1173                     ia, ia6_hash);
1174                 IN6_IFADDR_WUNLOCK();
1175         }
1176
1177         /* update timestamp */
1178         ia->ia6_updatetime = time_uptime;
1179
1180         /* set prefix mask */
1181         if (ifra->ifra_prefixmask.sin6_len) {
1182                 /*
1183                  * We prohibit changing the prefix length of an existing
1184                  * address, because
1185                  * + such an operation should be rare in IPv6, and
1186                  * + the operation would confuse prefix management.
1187                  */
1188                 if (ia->ia_prefixmask.sin6_len &&
1189                     in6_mask2len(&ia->ia_prefixmask.sin6_addr, NULL) != plen) {
1190                         nd6log((LOG_INFO, "in6_update_ifa: the prefix length of an"
1191                             " existing (%s) address should not be changed\n",
1192                             ip6_sprintf(ip6buf, &ia->ia_addr.sin6_addr)));
1193                         error = EINVAL;
1194                         goto unlink;
1195                 }
1196                 ia->ia_prefixmask = ifra->ifra_prefixmask;
1197                 ia->ia_prefixmask.sin6_family = AF_INET6;
1198         }
1199
1200         /*
1201          * If a new destination address is specified, scrub the old one and
1202          * install the new destination.  Note that the interface must be
1203          * p2p or loopback (see the check above.)
1204          */
1205         if (dst6.sin6_family == AF_INET6 &&
1206             !IN6_ARE_ADDR_EQUAL(&dst6.sin6_addr, &ia->ia_dstaddr.sin6_addr)) {
1207                 int e;
1208
1209                 if ((ia->ia_flags & IFA_ROUTE) != 0 &&
1210                     (e = rtinit(&(ia->ia_ifa), (int)RTM_DELETE, RTF_HOST)) != 0) {
1211                         nd6log((LOG_ERR, "in6_update_ifa: failed to remove "
1212                             "a route to the old destination: %s\n",
1213                             ip6_sprintf(ip6buf, &ia->ia_addr.sin6_addr)));
1214                         /* proceed anyway... */
1215                 } else
1216                         ia->ia_flags &= ~IFA_ROUTE;
1217                 ia->ia_dstaddr = dst6;
1218         }
1219
1220         /*
1221          * Set lifetimes.  We do not refer to ia6t_expire and ia6t_preferred
1222          * to see if the address is deprecated or invalidated, but initialize
1223          * these members for applications.
1224          */
1225         ia->ia6_lifetime = ifra->ifra_lifetime;
1226         if (ia->ia6_lifetime.ia6t_vltime != ND6_INFINITE_LIFETIME) {
1227                 ia->ia6_lifetime.ia6t_expire =
1228                     time_uptime + ia->ia6_lifetime.ia6t_vltime;
1229         } else
1230                 ia->ia6_lifetime.ia6t_expire = 0;
1231         if (ia->ia6_lifetime.ia6t_pltime != ND6_INFINITE_LIFETIME) {
1232                 ia->ia6_lifetime.ia6t_preferred =
1233                     time_uptime + ia->ia6_lifetime.ia6t_pltime;
1234         } else
1235                 ia->ia6_lifetime.ia6t_preferred = 0;
1236
1237         /* reset the interface and routing table appropriately. */
1238         if ((error = in6_ifinit(ifp, ia, &ifra->ifra_addr, hostIsNew)) != 0)
1239                 goto unlink;
1240
1241         /*
1242          * configure address flags.
1243          */
1244         ia->ia6_flags = ifra->ifra_flags;
1245         /*
1246          * backward compatibility - if IN6_IFF_DEPRECATED is set from the
1247          * userland, make it deprecated.
1248          */
1249         if ((ifra->ifra_flags & IN6_IFF_DEPRECATED) != 0) {
1250                 ia->ia6_lifetime.ia6t_pltime = 0;
1251                 ia->ia6_lifetime.ia6t_preferred = time_uptime;
1252         }
1253         /*
1254          * Make the address tentative before joining multicast addresses,
1255          * so that corresponding MLD responses would not have a tentative
1256          * source address.
1257          */
1258         ia->ia6_flags &= ~IN6_IFF_DUPLICATED;   /* safety */
1259         if (hostIsNew && in6if_do_dad(ifp))
1260                 ia->ia6_flags |= IN6_IFF_TENTATIVE;
1261
1262         /* DAD should be performed after ND6_IFF_IFDISABLED is cleared. */
1263         if (ND_IFINFO(ifp)->flags & ND6_IFF_IFDISABLED)
1264                 ia->ia6_flags |= IN6_IFF_TENTATIVE;
1265
1266         /*
1267          * We are done if we have simply modified an existing address.
1268          */
1269         if (!hostIsNew)
1270                 return (error);
1271
1272         /*
1273          * Beyond this point, we should call in6_purgeaddr upon an error,
1274          * not just go to unlink.
1275          */
1276
1277         /* Join necessary multicast groups. */
1278         in6m_sol = NULL;
1279         if ((ifp->if_flags & IFF_MULTICAST) != 0) {
1280                 error = in6_update_ifa_join_mc(ifp, ifra, ia, flags, &in6m_sol);
1281                 if (error)
1282                         goto cleanup;
1283         }
1284
1285         /*
1286          * Perform DAD, if needed.
1287          * XXX It may be of use, if we can administratively disable DAD.
1288          */
1289         if (in6if_do_dad(ifp) && ((ifra->ifra_flags & IN6_IFF_NODAD) == 0) &&
1290             (ia->ia6_flags & IN6_IFF_TENTATIVE))
1291         {
1292                 int mindelay, maxdelay;
1293
1294                 delay = 0;
1295                 if ((flags & IN6_IFAUPDATE_DADDELAY)) {
1296                         /*
1297                          * We need to impose a delay before sending an NS
1298                          * for DAD.  Check if we also needed a delay for the
1299                          * corresponding MLD message.  If we did, the delay
1300                          * should be larger than the MLD delay (this could be
1301                          * relaxed a bit, but this simple logic is at least
1302                          * safe).
1303                          * XXX: Break data hiding guidelines and look at
1304                          * state for the solicited multicast group.
1305                          */
1306                         mindelay = 0;
1307                         if (in6m_sol != NULL &&
1308                             in6m_sol->in6m_state == MLD_REPORTING_MEMBER) {
1309                                 mindelay = in6m_sol->in6m_timer;
1310                         }
1311                         maxdelay = MAX_RTR_SOLICITATION_DELAY * hz;
1312                         if (maxdelay - mindelay == 0)
1313                                 delay = 0;
1314                         else {
1315                                 delay =
1316                                     (arc4random() % (maxdelay - mindelay)) +
1317                                     mindelay;
1318                         }
1319                 }
1320                 nd6_dad_start((struct ifaddr *)ia, delay);
1321         }
1322
1323         KASSERT(hostIsNew, ("in6_update_ifa: !hostIsNew"));
1324         ifa_free(&ia->ia_ifa);
1325         return (error);
1326
1327   unlink:
1328         /*
1329          * XXX: if a change of an existing address failed, keep the entry
1330          * anyway.
1331          */
1332         if (hostIsNew) {
1333                 in6_unlink_ifa(ia, ifp);
1334                 ifa_free(&ia->ia_ifa);
1335         }
1336         return (error);
1337
1338   cleanup:
1339         KASSERT(hostIsNew, ("in6_update_ifa: cleanup: !hostIsNew"));
1340         ifa_free(&ia->ia_ifa);
1341         in6_purgeaddr(&ia->ia_ifa);
1342         return error;
1343 }
1344
1345 /*
1346  * Leave multicast groups.  Factored out from in6_purgeaddr().
1347  * This entire work should only be done once, for the default FIB.
1348  */
1349 static int
1350 in6_purgeaddr_mc(struct ifnet *ifp, struct in6_ifaddr *ia, struct ifaddr *ifa0)
1351 {
1352         struct sockaddr_in6 mltaddr, mltmask;
1353         struct in6_multi_mship *imm;
1354         struct rtentry *rt;
1355         struct sockaddr_in6 sin6;
1356         int error;
1357
1358         /*
1359          * Leave from multicast groups we have joined for the interface.
1360          */
1361         while ((imm = LIST_FIRST(&ia->ia6_memberships)) != NULL) {
1362                 LIST_REMOVE(imm, i6mm_chain);
1363                 in6_leavegroup(imm);
1364         }
1365
1366         /*
1367          * Remove the link-local all-nodes address.
1368          */
1369         bzero(&mltmask, sizeof(mltmask));
1370         mltmask.sin6_len = sizeof(struct sockaddr_in6);
1371         mltmask.sin6_family = AF_INET6;
1372         mltmask.sin6_addr = in6mask32;
1373
1374         bzero(&mltaddr, sizeof(mltaddr));
1375         mltaddr.sin6_len = sizeof(struct sockaddr_in6);
1376         mltaddr.sin6_family = AF_INET6;
1377         mltaddr.sin6_addr = in6addr_linklocal_allnodes;
1378
1379         if ((error = in6_setscope(&mltaddr.sin6_addr, ifp, NULL)) != 0)
1380                 return (error);
1381
1382         /*
1383          * As for the mltaddr above, proactively prepare the sin6 to avoid
1384          * rtentry un- and re-locking.
1385          */
1386         if (ifa0 != NULL) {
1387                 bzero(&sin6, sizeof(sin6));
1388                 sin6.sin6_len = sizeof(sin6);
1389                 sin6.sin6_family = AF_INET6;
1390                 memcpy(&sin6.sin6_addr, &satosin6(ifa0->ifa_addr)->sin6_addr,
1391                     sizeof(sin6.sin6_addr));
1392                 error = in6_setscope(&sin6.sin6_addr, ifa0->ifa_ifp, NULL);
1393                 if (error != 0)
1394                         return (error);
1395         }
1396
1397         rt = in6_rtalloc1((struct sockaddr *)&mltaddr, 0, 0UL, RT_DEFAULT_FIB);
1398         if (rt != NULL && rt->rt_gateway != NULL &&
1399             (memcmp(&satosin6(rt->rt_gateway)->sin6_addr,
1400                     &ia->ia_addr.sin6_addr,
1401                     sizeof(ia->ia_addr.sin6_addr)) == 0)) {
1402                 /*
1403                  * If no more IPv6 address exists on this interface then
1404                  * remove the multicast address route.
1405                  */
1406                 if (ifa0 == NULL) {
1407                         memcpy(&mltaddr.sin6_addr,
1408                             &satosin6(rt_key(rt))->sin6_addr,
1409                             sizeof(mltaddr.sin6_addr));
1410                         RTFREE_LOCKED(rt);
1411                         error = in6_rtrequest(RTM_DELETE,
1412                             (struct sockaddr *)&mltaddr,
1413                             (struct sockaddr *)&ia->ia_addr,
1414                             (struct sockaddr *)&mltmask, RTF_UP,
1415                             (struct rtentry **)0, RT_DEFAULT_FIB);
1416                         if (error)
1417                                 log(LOG_INFO, "%s: link-local all-nodes "
1418                                     "multicast address deletion error\n",
1419                                     __func__);
1420                 } else {
1421                         /*
1422                          * Replace the gateway of the route.
1423                          */
1424                         memcpy(rt->rt_gateway, &sin6, sizeof(sin6));
1425                         RTFREE_LOCKED(rt);
1426                 }
1427         } else {
1428                 if (rt != NULL)
1429                         RTFREE_LOCKED(rt);
1430         }
1431
1432         /*
1433          * Remove the node-local all-nodes address.
1434          */
1435         mltaddr.sin6_addr = in6addr_nodelocal_allnodes;
1436         if ((error = in6_setscope(&mltaddr.sin6_addr, ifp, NULL)) != 0)
1437                 return (error);
1438
1439         rt = in6_rtalloc1((struct sockaddr *)&mltaddr, 0, 0UL, RT_DEFAULT_FIB);
1440         if (rt != NULL && rt->rt_gateway != NULL &&
1441             (memcmp(&satosin6(rt->rt_gateway)->sin6_addr,
1442                     &ia->ia_addr.sin6_addr,
1443                     sizeof(ia->ia_addr.sin6_addr)) == 0)) {
1444                 /*
1445                  * If no more IPv6 address exists on this interface then
1446                  * remove the multicast address route.
1447                  */
1448                 if (ifa0 == NULL) {
1449                         memcpy(&mltaddr.sin6_addr,
1450                             &satosin6(rt_key(rt))->sin6_addr,
1451                             sizeof(mltaddr.sin6_addr));
1452
1453                         RTFREE_LOCKED(rt);
1454                         error = in6_rtrequest(RTM_DELETE,
1455                             (struct sockaddr *)&mltaddr,
1456                             (struct sockaddr *)&ia->ia_addr,
1457                             (struct sockaddr *)&mltmask, RTF_UP,
1458                             (struct rtentry **)0, RT_DEFAULT_FIB);
1459                         if (error)
1460                                 log(LOG_INFO, "%s: node-local all-nodes"
1461                                     "multicast address deletion error\n",
1462                                     __func__);
1463                 } else {
1464                         /*
1465                          * Replace the gateway of the route.
1466                          */
1467                         memcpy(rt->rt_gateway, &sin6, sizeof(sin6));
1468                         RTFREE_LOCKED(rt);
1469                 }
1470         } else {
1471                 if (rt != NULL)
1472                         RTFREE_LOCKED(rt);
1473         }
1474
1475         return (0);
1476 }
1477
1478 void
1479 in6_purgeaddr(struct ifaddr *ifa)
1480 {
1481         struct ifnet *ifp = ifa->ifa_ifp;
1482         struct in6_ifaddr *ia = (struct in6_ifaddr *) ifa;
1483         int plen, error;
1484         struct ifaddr *ifa0;
1485
1486         if (ifa->ifa_carp)
1487                 (*carp_detach_p)(ifa);
1488
1489         /*
1490          * find another IPv6 address as the gateway for the
1491          * link-local and node-local all-nodes multicast
1492          * address routes
1493          */
1494         IF_ADDR_RLOCK(ifp);
1495         TAILQ_FOREACH(ifa0, &ifp->if_addrhead, ifa_link) {
1496                 if ((ifa0->ifa_addr->sa_family != AF_INET6) ||
1497                     memcmp(&satosin6(ifa0->ifa_addr)->sin6_addr,
1498                     &ia->ia_addr.sin6_addr, sizeof(struct in6_addr)) == 0)
1499                         continue;
1500                 else
1501                         break;
1502         }
1503         if (ifa0 != NULL)
1504                 ifa_ref(ifa0);
1505         IF_ADDR_RUNLOCK(ifp);
1506
1507         /*
1508          * Remove the loopback route to the interface address.
1509          * The check for the current setting of "nd6_useloopback"
1510          * is not needed.
1511          */
1512         if (ia->ia_flags & IFA_RTSELF) {
1513                 error = ifa_del_loopback_route((struct ifaddr *)ia,
1514                     (struct sockaddr *)&ia->ia_addr);
1515                 if (error == 0)
1516                         ia->ia_flags &= ~IFA_RTSELF;
1517         }
1518
1519         /* stop DAD processing */
1520         nd6_dad_stop(ifa);
1521
1522         /* Remove local address entry from lltable. */
1523         in6_ifremloop(ifa);
1524
1525         /* Leave multicast groups. */
1526         error = in6_purgeaddr_mc(ifp, ia, ifa0);
1527
1528         if (ifa0 != NULL)
1529                 ifa_free(ifa0);
1530
1531         plen = in6_mask2len(&ia->ia_prefixmask.sin6_addr, NULL); /* XXX */
1532         if ((ia->ia_flags & IFA_ROUTE) && plen == 128) {
1533                 error = rtinit(&(ia->ia_ifa), RTM_DELETE, ia->ia_flags |
1534                     (ia->ia_dstaddr.sin6_family == AF_INET6) ? RTF_HOST : 0);
1535                 if (error != 0)
1536                         log(LOG_INFO, "%s: err=%d, destination address delete "
1537                             "failed\n", __func__, error);
1538                 ia->ia_flags &= ~IFA_ROUTE;
1539         }
1540
1541         in6_unlink_ifa(ia, ifp);
1542 }
1543
1544 static void
1545 in6_unlink_ifa(struct in6_ifaddr *ia, struct ifnet *ifp)
1546 {
1547         char ip6buf[INET6_ADDRSTRLEN];
1548
1549         IF_ADDR_WLOCK(ifp);
1550         TAILQ_REMOVE(&ifp->if_addrhead, &ia->ia_ifa, ifa_link);
1551         IF_ADDR_WUNLOCK(ifp);
1552         ifa_free(&ia->ia_ifa);                  /* if_addrhead */
1553
1554         /*
1555          * Defer the release of what might be the last reference to the
1556          * in6_ifaddr so that it can't be freed before the remainder of the
1557          * cleanup.
1558          */
1559         IN6_IFADDR_WLOCK();
1560         TAILQ_REMOVE(&V_in6_ifaddrhead, ia, ia_link);
1561         LIST_REMOVE(ia, ia6_hash);
1562         IN6_IFADDR_WUNLOCK();
1563
1564         /*
1565          * Release the reference to the base prefix.  There should be a
1566          * positive reference.
1567          */
1568         if (ia->ia6_ndpr == NULL) {
1569                 nd6log((LOG_NOTICE,
1570                     "in6_unlink_ifa: autoconf'ed address "
1571                     "%s has no prefix\n", ip6_sprintf(ip6buf, IA6_IN6(ia))));
1572         } else {
1573                 ia->ia6_ndpr->ndpr_refcnt--;
1574                 ia->ia6_ndpr = NULL;
1575         }
1576
1577         /*
1578          * Also, if the address being removed is autoconf'ed, call
1579          * pfxlist_onlink_check() since the release might affect the status of
1580          * other (detached) addresses.
1581          */
1582         if ((ia->ia6_flags & IN6_IFF_AUTOCONF)) {
1583                 pfxlist_onlink_check();
1584         }
1585         ifa_free(&ia->ia_ifa);                  /* in6_ifaddrhead */
1586 }
1587
1588 void
1589 in6_purgeif(struct ifnet *ifp)
1590 {
1591         struct ifaddr *ifa, *nifa;
1592
1593         TAILQ_FOREACH_SAFE(ifa, &ifp->if_addrhead, ifa_link, nifa) {
1594                 if (ifa->ifa_addr->sa_family != AF_INET6)
1595                         continue;
1596                 in6_purgeaddr(ifa);
1597         }
1598
1599         in6_ifdetach(ifp);
1600 }
1601
1602 /*
1603  * SIOC[GAD]LIFADDR.
1604  *      SIOCGLIFADDR: get first address. (?)
1605  *      SIOCGLIFADDR with IFLR_PREFIX:
1606  *              get first address that matches the specified prefix.
1607  *      SIOCALIFADDR: add the specified address.
1608  *      SIOCALIFADDR with IFLR_PREFIX:
1609  *              add the specified prefix, filling hostid part from
1610  *              the first link-local address.  prefixlen must be <= 64.
1611  *      SIOCDLIFADDR: delete the specified address.
1612  *      SIOCDLIFADDR with IFLR_PREFIX:
1613  *              delete the first address that matches the specified prefix.
1614  * return values:
1615  *      EINVAL on invalid parameters
1616  *      EADDRNOTAVAIL on prefix match failed/specified address not found
1617  *      other values may be returned from in6_ioctl()
1618  *
1619  * NOTE: SIOCALIFADDR(with IFLR_PREFIX set) allows prefixlen less than 64.
1620  * this is to accomodate address naming scheme other than RFC2374,
1621  * in the future.
1622  * RFC2373 defines interface id to be 64bit, but it allows non-RFC2374
1623  * address encoding scheme. (see figure on page 8)
1624  */
1625 static int
1626 in6_lifaddr_ioctl(struct socket *so, u_long cmd, caddr_t data,
1627     struct ifnet *ifp, struct thread *td)
1628 {
1629         struct if_laddrreq *iflr = (struct if_laddrreq *)data;
1630         struct ifaddr *ifa;
1631         struct sockaddr *sa;
1632
1633         /* sanity checks */
1634         if (!data || !ifp) {
1635                 panic("invalid argument to in6_lifaddr_ioctl");
1636                 /* NOTREACHED */
1637         }
1638
1639         switch (cmd) {
1640         case SIOCGLIFADDR:
1641                 /* address must be specified on GET with IFLR_PREFIX */
1642                 if ((iflr->flags & IFLR_PREFIX) == 0)
1643                         break;
1644                 /* FALLTHROUGH */
1645         case SIOCALIFADDR:
1646         case SIOCDLIFADDR:
1647                 /* address must be specified on ADD and DELETE */
1648                 sa = (struct sockaddr *)&iflr->addr;
1649                 if (sa->sa_family != AF_INET6)
1650                         return EINVAL;
1651                 if (sa->sa_len != sizeof(struct sockaddr_in6))
1652                         return EINVAL;
1653                 /* XXX need improvement */
1654                 sa = (struct sockaddr *)&iflr->dstaddr;
1655                 if (sa->sa_family && sa->sa_family != AF_INET6)
1656                         return EINVAL;
1657                 if (sa->sa_len && sa->sa_len != sizeof(struct sockaddr_in6))
1658                         return EINVAL;
1659                 break;
1660         default: /* shouldn't happen */
1661 #if 0
1662                 panic("invalid cmd to in6_lifaddr_ioctl");
1663                 /* NOTREACHED */
1664 #else
1665                 return EOPNOTSUPP;
1666 #endif
1667         }
1668         if (sizeof(struct in6_addr) * 8 < iflr->prefixlen)
1669                 return EINVAL;
1670
1671         switch (cmd) {
1672         case SIOCALIFADDR:
1673             {
1674                 struct in6_aliasreq ifra;
1675                 struct in6_addr *hostid = NULL;
1676                 int prefixlen;
1677
1678                 ifa = NULL;
1679                 if ((iflr->flags & IFLR_PREFIX) != 0) {
1680                         struct sockaddr_in6 *sin6;
1681
1682                         /*
1683                          * hostid is to fill in the hostid part of the
1684                          * address.  hostid points to the first link-local
1685                          * address attached to the interface.
1686                          */
1687                         ifa = (struct ifaddr *)in6ifa_ifpforlinklocal(ifp, 0);
1688                         if (!ifa)
1689                                 return EADDRNOTAVAIL;
1690                         hostid = IFA_IN6(ifa);
1691
1692                         /* prefixlen must be <= 64. */
1693                         if (64 < iflr->prefixlen) {
1694                                 if (ifa != NULL)
1695                                         ifa_free(ifa);
1696                                 return EINVAL;
1697                         }
1698                         prefixlen = iflr->prefixlen;
1699
1700                         /* hostid part must be zero. */
1701                         sin6 = (struct sockaddr_in6 *)&iflr->addr;
1702                         if (sin6->sin6_addr.s6_addr32[2] != 0 ||
1703                             sin6->sin6_addr.s6_addr32[3] != 0) {
1704                                 if (ifa != NULL)
1705                                         ifa_free(ifa);
1706                                 return EINVAL;
1707                         }
1708                 } else
1709                         prefixlen = iflr->prefixlen;
1710
1711                 /* copy args to in6_aliasreq, perform ioctl(SIOCAIFADDR_IN6). */
1712                 bzero(&ifra, sizeof(ifra));
1713                 bcopy(iflr->iflr_name, ifra.ifra_name, sizeof(ifra.ifra_name));
1714
1715                 bcopy(&iflr->addr, &ifra.ifra_addr,
1716                     ((struct sockaddr *)&iflr->addr)->sa_len);
1717                 if (hostid) {
1718                         /* fill in hostid part */
1719                         ifra.ifra_addr.sin6_addr.s6_addr32[2] =
1720                             hostid->s6_addr32[2];
1721                         ifra.ifra_addr.sin6_addr.s6_addr32[3] =
1722                             hostid->s6_addr32[3];
1723                 }
1724
1725                 if (((struct sockaddr *)&iflr->dstaddr)->sa_family) { /* XXX */
1726                         bcopy(&iflr->dstaddr, &ifra.ifra_dstaddr,
1727                             ((struct sockaddr *)&iflr->dstaddr)->sa_len);
1728                         if (hostid) {
1729                                 ifra.ifra_dstaddr.sin6_addr.s6_addr32[2] =
1730                                     hostid->s6_addr32[2];
1731                                 ifra.ifra_dstaddr.sin6_addr.s6_addr32[3] =
1732                                     hostid->s6_addr32[3];
1733                         }
1734                 }
1735                 if (ifa != NULL)
1736                         ifa_free(ifa);
1737
1738                 ifra.ifra_prefixmask.sin6_len = sizeof(struct sockaddr_in6);
1739                 in6_prefixlen2mask(&ifra.ifra_prefixmask.sin6_addr, prefixlen);
1740
1741                 ifra.ifra_flags = iflr->flags & ~IFLR_PREFIX;
1742                 return in6_control(so, SIOCAIFADDR_IN6, (caddr_t)&ifra, ifp, td);
1743             }
1744         case SIOCGLIFADDR:
1745         case SIOCDLIFADDR:
1746             {
1747                 struct in6_ifaddr *ia;
1748                 struct in6_addr mask, candidate, match;
1749                 struct sockaddr_in6 *sin6;
1750                 int cmp;
1751
1752                 bzero(&mask, sizeof(mask));
1753                 if (iflr->flags & IFLR_PREFIX) {
1754                         /* lookup a prefix rather than address. */
1755                         in6_prefixlen2mask(&mask, iflr->prefixlen);
1756
1757                         sin6 = (struct sockaddr_in6 *)&iflr->addr;
1758                         bcopy(&sin6->sin6_addr, &match, sizeof(match));
1759                         match.s6_addr32[0] &= mask.s6_addr32[0];
1760                         match.s6_addr32[1] &= mask.s6_addr32[1];
1761                         match.s6_addr32[2] &= mask.s6_addr32[2];
1762                         match.s6_addr32[3] &= mask.s6_addr32[3];
1763
1764                         /* if you set extra bits, that's wrong */
1765                         if (bcmp(&match, &sin6->sin6_addr, sizeof(match)))
1766                                 return EINVAL;
1767
1768                         cmp = 1;
1769                 } else {
1770                         if (cmd == SIOCGLIFADDR) {
1771                                 /* on getting an address, take the 1st match */
1772                                 cmp = 0;        /* XXX */
1773                         } else {
1774                                 /* on deleting an address, do exact match */
1775                                 in6_prefixlen2mask(&mask, 128);
1776                                 sin6 = (struct sockaddr_in6 *)&iflr->addr;
1777                                 bcopy(&sin6->sin6_addr, &match, sizeof(match));
1778
1779                                 cmp = 1;
1780                         }
1781                 }
1782
1783                 IF_ADDR_RLOCK(ifp);
1784                 TAILQ_FOREACH(ifa, &ifp->if_addrhead, ifa_link) {
1785                         if (ifa->ifa_addr->sa_family != AF_INET6)
1786                                 continue;
1787                         if (!cmp)
1788                                 break;
1789
1790                         /*
1791                          * XXX: this is adhoc, but is necessary to allow
1792                          * a user to specify fe80::/64 (not /10) for a
1793                          * link-local address.
1794                          */
1795                         bcopy(IFA_IN6(ifa), &candidate, sizeof(candidate));
1796                         in6_clearscope(&candidate);
1797                         candidate.s6_addr32[0] &= mask.s6_addr32[0];
1798                         candidate.s6_addr32[1] &= mask.s6_addr32[1];
1799                         candidate.s6_addr32[2] &= mask.s6_addr32[2];
1800                         candidate.s6_addr32[3] &= mask.s6_addr32[3];
1801                         if (IN6_ARE_ADDR_EQUAL(&candidate, &match))
1802                                 break;
1803                 }
1804                 if (ifa != NULL)
1805                         ifa_ref(ifa);
1806                 IF_ADDR_RUNLOCK(ifp);
1807                 if (!ifa)
1808                         return EADDRNOTAVAIL;
1809                 ia = ifa2ia6(ifa);
1810
1811                 if (cmd == SIOCGLIFADDR) {
1812                         int error;
1813
1814                         /* fill in the if_laddrreq structure */
1815                         bcopy(&ia->ia_addr, &iflr->addr, ia->ia_addr.sin6_len);
1816                         error = sa6_recoverscope(
1817                             (struct sockaddr_in6 *)&iflr->addr);
1818                         if (error != 0) {
1819                                 ifa_free(ifa);
1820                                 return (error);
1821                         }
1822
1823                         if ((ifp->if_flags & IFF_POINTOPOINT) != 0) {
1824                                 bcopy(&ia->ia_dstaddr, &iflr->dstaddr,
1825                                     ia->ia_dstaddr.sin6_len);
1826                                 error = sa6_recoverscope(
1827                                     (struct sockaddr_in6 *)&iflr->dstaddr);
1828                                 if (error != 0) {
1829                                         ifa_free(ifa);
1830                                         return (error);
1831                                 }
1832                         } else
1833                                 bzero(&iflr->dstaddr, sizeof(iflr->dstaddr));
1834
1835                         iflr->prefixlen =
1836                             in6_mask2len(&ia->ia_prefixmask.sin6_addr, NULL);
1837
1838                         iflr->flags = ia->ia6_flags;    /* XXX */
1839                         ifa_free(ifa);
1840
1841                         return 0;
1842                 } else {
1843                         struct in6_aliasreq ifra;
1844
1845                         /* fill in6_aliasreq and do ioctl(SIOCDIFADDR_IN6) */
1846                         bzero(&ifra, sizeof(ifra));
1847                         bcopy(iflr->iflr_name, ifra.ifra_name,
1848                             sizeof(ifra.ifra_name));
1849
1850                         bcopy(&ia->ia_addr, &ifra.ifra_addr,
1851                             ia->ia_addr.sin6_len);
1852                         if ((ifp->if_flags & IFF_POINTOPOINT) != 0) {
1853                                 bcopy(&ia->ia_dstaddr, &ifra.ifra_dstaddr,
1854                                     ia->ia_dstaddr.sin6_len);
1855                         } else {
1856                                 bzero(&ifra.ifra_dstaddr,
1857                                     sizeof(ifra.ifra_dstaddr));
1858                         }
1859                         bcopy(&ia->ia_prefixmask, &ifra.ifra_dstaddr,
1860                             ia->ia_prefixmask.sin6_len);
1861
1862                         ifra.ifra_flags = ia->ia6_flags;
1863                         ifa_free(ifa);
1864                         return in6_control(so, SIOCDIFADDR_IN6, (caddr_t)&ifra,
1865                             ifp, td);
1866                 }
1867             }
1868         }
1869
1870         return EOPNOTSUPP;      /* just for safety */
1871 }
1872
1873 /*
1874  * Initialize an interface's IPv6 address and routing table entry.
1875  */
1876 static int
1877 in6_ifinit(struct ifnet *ifp, struct in6_ifaddr *ia,
1878     struct sockaddr_in6 *sin6, int newhost)
1879 {
1880         int     error = 0, plen, ifacount = 0;
1881         struct ifaddr *ifa;
1882
1883         /*
1884          * Give the interface a chance to initialize
1885          * if this is its first address,
1886          * and to validate the address if necessary.
1887          */
1888         IF_ADDR_RLOCK(ifp);
1889         TAILQ_FOREACH(ifa, &ifp->if_addrhead, ifa_link) {
1890                 if (ifa->ifa_addr->sa_family != AF_INET6)
1891                         continue;
1892                 ifacount++;
1893         }
1894         IF_ADDR_RUNLOCK(ifp);
1895
1896         ia->ia_addr = *sin6;
1897
1898         if (ifacount <= 1 && ifp->if_ioctl) {
1899                 error = (*ifp->if_ioctl)(ifp, SIOCSIFADDR, (caddr_t)ia);
1900                 if (error)
1901                         return (error);
1902         }
1903
1904         ia->ia_ifa.ifa_metric = ifp->if_metric;
1905
1906         /* we could do in(6)_socktrim here, but just omit it at this moment. */
1907
1908         /*
1909          * Special case:
1910          * If a new destination address is specified for a point-to-point
1911          * interface, install a route to the destination as an interface
1912          * direct route.
1913          * XXX: the logic below rejects assigning multiple addresses on a p2p
1914          * interface that share the same destination.
1915          */
1916         plen = in6_mask2len(&ia->ia_prefixmask.sin6_addr, NULL); /* XXX */
1917         if (!(ia->ia_flags & IFA_ROUTE) && plen == 128 &&
1918             ia->ia_dstaddr.sin6_family == AF_INET6) {
1919                 int rtflags = RTF_UP | RTF_HOST;
1920                 error = rtinit(&ia->ia_ifa, RTM_ADD, ia->ia_flags | rtflags);
1921                 if (error)
1922                         return (error);
1923                 ia->ia_flags |= IFA_ROUTE;
1924                 /*
1925                  * Handle the case for ::1 .
1926                  */
1927                 if (ifp->if_flags & IFF_LOOPBACK)
1928                         ia->ia_flags |= IFA_RTSELF;
1929         }
1930
1931         /*
1932          * add a loopback route to self
1933          */
1934         if (!(ia->ia_flags & IFA_RTSELF) && V_nd6_useloopback) {
1935                 error = ifa_add_loopback_route((struct ifaddr *)ia,
1936                     (struct sockaddr *)&ia->ia_addr);
1937                 if (error == 0)
1938                         ia->ia_flags |= IFA_RTSELF;
1939         }
1940
1941         /* Add local address to lltable, if necessary (ex. on p2p link). */
1942         if (newhost)
1943                 in6_ifaddloop(&(ia->ia_ifa));
1944
1945         return (error);
1946 }
1947
1948 /*
1949  * Find an IPv6 interface link-local address specific to an interface.
1950  * ifaddr is returned referenced.
1951  */
1952 struct in6_ifaddr *
1953 in6ifa_ifpforlinklocal(struct ifnet *ifp, int ignoreflags)
1954 {
1955         struct ifaddr *ifa;
1956
1957         IF_ADDR_RLOCK(ifp);
1958         TAILQ_FOREACH(ifa, &ifp->if_addrhead, ifa_link) {
1959                 if (ifa->ifa_addr->sa_family != AF_INET6)
1960                         continue;
1961                 if (IN6_IS_ADDR_LINKLOCAL(IFA_IN6(ifa))) {
1962                         if ((((struct in6_ifaddr *)ifa)->ia6_flags &
1963                             ignoreflags) != 0)
1964                                 continue;
1965                         ifa_ref(ifa);
1966                         break;
1967                 }
1968         }
1969         IF_ADDR_RUNLOCK(ifp);
1970
1971         return ((struct in6_ifaddr *)ifa);
1972 }
1973
1974
1975 /*
1976  * find the internet address corresponding to a given interface and address.
1977  * ifaddr is returned referenced.
1978  */
1979 struct in6_ifaddr *
1980 in6ifa_ifpwithaddr(struct ifnet *ifp, struct in6_addr *addr)
1981 {
1982         struct ifaddr *ifa;
1983
1984         IF_ADDR_RLOCK(ifp);
1985         TAILQ_FOREACH(ifa, &ifp->if_addrhead, ifa_link) {
1986                 if (ifa->ifa_addr->sa_family != AF_INET6)
1987                         continue;
1988                 if (IN6_ARE_ADDR_EQUAL(addr, IFA_IN6(ifa))) {
1989                         ifa_ref(ifa);
1990                         break;
1991                 }
1992         }
1993         IF_ADDR_RUNLOCK(ifp);
1994
1995         return ((struct in6_ifaddr *)ifa);
1996 }
1997
1998 /*
1999  * Find a link-local scoped address on ifp and return it if any.
2000  */
2001 struct in6_ifaddr *
2002 in6ifa_llaonifp(struct ifnet *ifp)
2003 {
2004         struct sockaddr_in6 *sin6;
2005         struct ifaddr *ifa;
2006
2007         if (ND_IFINFO(ifp)->flags & ND6_IFF_IFDISABLED)
2008                 return (NULL);
2009         if_addr_rlock(ifp);
2010         TAILQ_FOREACH(ifa, &ifp->if_addrhead, ifa_link) {
2011                 if (ifa->ifa_addr->sa_family != AF_INET6)
2012                         continue;
2013                 sin6 = (struct sockaddr_in6 *)ifa->ifa_addr;
2014                 if (IN6_IS_SCOPE_LINKLOCAL(&sin6->sin6_addr) ||
2015                     IN6_IS_ADDR_MC_INTFACELOCAL(&sin6->sin6_addr) ||
2016                     IN6_IS_ADDR_MC_NODELOCAL(&sin6->sin6_addr))
2017                         break;
2018         }
2019         if_addr_runlock(ifp);
2020
2021         return ((struct in6_ifaddr *)ifa);
2022 }
2023
2024 /*
2025  * Convert IP6 address to printable (loggable) representation. Caller
2026  * has to make sure that ip6buf is at least INET6_ADDRSTRLEN long.
2027  */
2028 static char digits[] = "0123456789abcdef";
2029 char *
2030 ip6_sprintf(char *ip6buf, const struct in6_addr *addr)
2031 {
2032         int i, cnt = 0, maxcnt = 0, idx = 0, index = 0;
2033         char *cp;
2034         const u_int16_t *a = (const u_int16_t *)addr;
2035         const u_int8_t *d;
2036         int dcolon = 0, zero = 0;
2037
2038         cp = ip6buf;
2039
2040         for (i = 0; i < 8; i++) {
2041                 if (*(a + i) == 0) {
2042                         cnt++;
2043                         if (cnt == 1)
2044                                 idx = i;
2045                 }
2046                 else if (maxcnt < cnt) {
2047                         maxcnt = cnt;
2048                         index = idx;
2049                         cnt = 0;
2050                 }
2051         }
2052         if (maxcnt < cnt) {
2053                 maxcnt = cnt;
2054                 index = idx;
2055         }
2056
2057         for (i = 0; i < 8; i++) {
2058                 if (dcolon == 1) {
2059                         if (*a == 0) {
2060                                 if (i == 7)
2061                                         *cp++ = ':';
2062                                 a++;
2063                                 continue;
2064                         } else
2065                                 dcolon = 2;
2066                 }
2067                 if (*a == 0) {
2068                         if (dcolon == 0 && *(a + 1) == 0 && i == index) {
2069                                 if (i == 0)
2070                                         *cp++ = ':';
2071                                 *cp++ = ':';
2072                                 dcolon = 1;
2073                         } else {
2074                                 *cp++ = '0';
2075                                 *cp++ = ':';
2076                         }
2077                         a++;
2078                         continue;
2079                 }
2080                 d = (const u_char *)a;
2081                 /* Try to eliminate leading zeros in printout like in :0001. */
2082                 zero = 1;
2083                 *cp = digits[*d >> 4];
2084                 if (*cp != '0') {
2085                         zero = 0;
2086                         cp++;
2087                 }
2088                 *cp = digits[*d++ & 0xf];
2089                 if (zero == 0 || (*cp != '0')) {
2090                         zero = 0;
2091                         cp++;
2092                 }
2093                 *cp = digits[*d >> 4];
2094                 if (zero == 0 || (*cp != '0')) {
2095                         zero = 0;
2096                         cp++;
2097                 }
2098                 *cp++ = digits[*d & 0xf];
2099                 *cp++ = ':';
2100                 a++;
2101         }
2102         *--cp = '\0';
2103         return (ip6buf);
2104 }
2105
2106 int
2107 in6_localaddr(struct in6_addr *in6)
2108 {
2109         struct in6_ifaddr *ia;
2110
2111         if (IN6_IS_ADDR_LOOPBACK(in6) || IN6_IS_ADDR_LINKLOCAL(in6))
2112                 return 1;
2113
2114         IN6_IFADDR_RLOCK();
2115         TAILQ_FOREACH(ia, &V_in6_ifaddrhead, ia_link) {
2116                 if (IN6_ARE_MASKED_ADDR_EQUAL(in6, &ia->ia_addr.sin6_addr,
2117                     &ia->ia_prefixmask.sin6_addr)) {
2118                         IN6_IFADDR_RUNLOCK();
2119                         return 1;
2120                 }
2121         }
2122         IN6_IFADDR_RUNLOCK();
2123
2124         return (0);
2125 }
2126
2127 /*
2128  * Return 1 if an internet address is for the local host and configured
2129  * on one of its interfaces.
2130  */
2131 int
2132 in6_localip(struct in6_addr *in6)
2133 {
2134         struct in6_ifaddr *ia;
2135
2136         IN6_IFADDR_RLOCK();
2137         LIST_FOREACH(ia, IN6ADDR_HASH(in6), ia6_hash) {
2138                 if (IN6_ARE_ADDR_EQUAL(in6, &ia->ia_addr.sin6_addr)) {
2139                         IN6_IFADDR_RUNLOCK();
2140                         return (1);
2141                 }
2142         }
2143         IN6_IFADDR_RUNLOCK();
2144         return (0);
2145 }
2146
2147 int
2148 in6_is_addr_deprecated(struct sockaddr_in6 *sa6)
2149 {
2150         struct in6_ifaddr *ia;
2151
2152         IN6_IFADDR_RLOCK();
2153         LIST_FOREACH(ia, IN6ADDR_HASH(&sa6->sin6_addr), ia6_hash) {
2154                 if (IN6_ARE_ADDR_EQUAL(IA6_IN6(ia), &sa6->sin6_addr)) {
2155                         if (ia->ia6_flags & IN6_IFF_DEPRECATED) {
2156                                 IN6_IFADDR_RUNLOCK();
2157                                 return (1); /* true */
2158                         }
2159                         break;
2160                 }
2161         }
2162         IN6_IFADDR_RUNLOCK();
2163
2164         return (0);             /* false */
2165 }
2166
2167 /*
2168  * return length of part which dst and src are equal
2169  * hard coding...
2170  */
2171 int
2172 in6_matchlen(struct in6_addr *src, struct in6_addr *dst)
2173 {
2174         int match = 0;
2175         u_char *s = (u_char *)src, *d = (u_char *)dst;
2176         u_char *lim = s + 16, r;
2177
2178         while (s < lim)
2179                 if ((r = (*d++ ^ *s++)) != 0) {
2180                         while (r < 128) {
2181                                 match++;
2182                                 r <<= 1;
2183                         }
2184                         break;
2185                 } else
2186                         match += 8;
2187         return match;
2188 }
2189
2190 /* XXX: to be scope conscious */
2191 int
2192 in6_are_prefix_equal(struct in6_addr *p1, struct in6_addr *p2, int len)
2193 {
2194         int bytelen, bitlen;
2195
2196         /* sanity check */
2197         if (0 > len || len > 128) {
2198                 log(LOG_ERR, "in6_are_prefix_equal: invalid prefix length(%d)\n",
2199                     len);
2200                 return (0);
2201         }
2202
2203         bytelen = len / 8;
2204         bitlen = len % 8;
2205
2206         if (bcmp(&p1->s6_addr, &p2->s6_addr, bytelen))
2207                 return (0);
2208         if (bitlen != 0 &&
2209             p1->s6_addr[bytelen] >> (8 - bitlen) !=
2210             p2->s6_addr[bytelen] >> (8 - bitlen))
2211                 return (0);
2212
2213         return (1);
2214 }
2215
2216 void
2217 in6_prefixlen2mask(struct in6_addr *maskp, int len)
2218 {
2219         u_char maskarray[8] = {0x80, 0xc0, 0xe0, 0xf0, 0xf8, 0xfc, 0xfe, 0xff};
2220         int bytelen, bitlen, i;
2221
2222         /* sanity check */
2223         if (0 > len || len > 128) {
2224                 log(LOG_ERR, "in6_prefixlen2mask: invalid prefix length(%d)\n",
2225                     len);
2226                 return;
2227         }
2228
2229         bzero(maskp, sizeof(*maskp));
2230         bytelen = len / 8;
2231         bitlen = len % 8;
2232         for (i = 0; i < bytelen; i++)
2233                 maskp->s6_addr[i] = 0xff;
2234         if (bitlen)
2235                 maskp->s6_addr[bytelen] = maskarray[bitlen - 1];
2236 }
2237
2238 /*
2239  * return the best address out of the same scope. if no address was
2240  * found, return the first valid address from designated IF.
2241  */
2242 struct in6_ifaddr *
2243 in6_ifawithifp(struct ifnet *ifp, struct in6_addr *dst)
2244 {
2245         int dst_scope = in6_addrscope(dst), blen = -1, tlen;
2246         struct ifaddr *ifa;
2247         struct in6_ifaddr *besta = 0;
2248         struct in6_ifaddr *dep[2];      /* last-resort: deprecated */
2249
2250         dep[0] = dep[1] = NULL;
2251
2252         /*
2253          * We first look for addresses in the same scope.
2254          * If there is one, return it.
2255          * If two or more, return one which matches the dst longest.
2256          * If none, return one of global addresses assigned other ifs.
2257          */
2258         IF_ADDR_RLOCK(ifp);
2259         TAILQ_FOREACH(ifa, &ifp->if_addrhead, ifa_link) {
2260                 if (ifa->ifa_addr->sa_family != AF_INET6)
2261                         continue;
2262                 if (((struct in6_ifaddr *)ifa)->ia6_flags & IN6_IFF_ANYCAST)
2263                         continue; /* XXX: is there any case to allow anycast? */
2264                 if (((struct in6_ifaddr *)ifa)->ia6_flags & IN6_IFF_NOTREADY)
2265                         continue; /* don't use this interface */
2266                 if (((struct in6_ifaddr *)ifa)->ia6_flags & IN6_IFF_DETACHED)
2267                         continue;
2268                 if (((struct in6_ifaddr *)ifa)->ia6_flags & IN6_IFF_DEPRECATED) {
2269                         if (V_ip6_use_deprecated)
2270                                 dep[0] = (struct in6_ifaddr *)ifa;
2271                         continue;
2272                 }
2273
2274                 if (dst_scope == in6_addrscope(IFA_IN6(ifa))) {
2275                         /*
2276                          * call in6_matchlen() as few as possible
2277                          */
2278                         if (besta) {
2279                                 if (blen == -1)
2280                                         blen = in6_matchlen(&besta->ia_addr.sin6_addr, dst);
2281                                 tlen = in6_matchlen(IFA_IN6(ifa), dst);
2282                                 if (tlen > blen) {
2283                                         blen = tlen;
2284                                         besta = (struct in6_ifaddr *)ifa;
2285                                 }
2286                         } else
2287                                 besta = (struct in6_ifaddr *)ifa;
2288                 }
2289         }
2290         if (besta) {
2291                 ifa_ref(&besta->ia_ifa);
2292                 IF_ADDR_RUNLOCK(ifp);
2293                 return (besta);
2294         }
2295
2296         TAILQ_FOREACH(ifa, &ifp->if_addrhead, ifa_link) {
2297                 if (ifa->ifa_addr->sa_family != AF_INET6)
2298                         continue;
2299                 if (((struct in6_ifaddr *)ifa)->ia6_flags & IN6_IFF_ANYCAST)
2300                         continue; /* XXX: is there any case to allow anycast? */
2301                 if (((struct in6_ifaddr *)ifa)->ia6_flags & IN6_IFF_NOTREADY)
2302                         continue; /* don't use this interface */
2303                 if (((struct in6_ifaddr *)ifa)->ia6_flags & IN6_IFF_DETACHED)
2304                         continue;
2305                 if (((struct in6_ifaddr *)ifa)->ia6_flags & IN6_IFF_DEPRECATED) {
2306                         if (V_ip6_use_deprecated)
2307                                 dep[1] = (struct in6_ifaddr *)ifa;
2308                         continue;
2309                 }
2310
2311                 if (ifa != NULL)
2312                         ifa_ref(ifa);
2313                 IF_ADDR_RUNLOCK(ifp);
2314                 return (struct in6_ifaddr *)ifa;
2315         }
2316
2317         /* use the last-resort values, that are, deprecated addresses */
2318         if (dep[0]) {
2319                 ifa_ref((struct ifaddr *)dep[0]);
2320                 IF_ADDR_RUNLOCK(ifp);
2321                 return dep[0];
2322         }
2323         if (dep[1]) {
2324                 ifa_ref((struct ifaddr *)dep[1]);
2325                 IF_ADDR_RUNLOCK(ifp);
2326                 return dep[1];
2327         }
2328
2329         IF_ADDR_RUNLOCK(ifp);
2330         return NULL;
2331 }
2332
2333 /*
2334  * perform DAD when interface becomes IFF_UP.
2335  */
2336 void
2337 in6_if_up(struct ifnet *ifp)
2338 {
2339         struct ifaddr *ifa;
2340         struct in6_ifaddr *ia;
2341
2342         IF_ADDR_RLOCK(ifp);
2343         TAILQ_FOREACH(ifa, &ifp->if_addrhead, ifa_link) {
2344                 if (ifa->ifa_addr->sa_family != AF_INET6)
2345                         continue;
2346                 ia = (struct in6_ifaddr *)ifa;
2347                 if (ia->ia6_flags & IN6_IFF_TENTATIVE) {
2348                         /*
2349                          * The TENTATIVE flag was likely set by hand
2350                          * beforehand, implicitly indicating the need for DAD.
2351                          * We may be able to skip the random delay in this
2352                          * case, but we impose delays just in case.
2353                          */
2354                         nd6_dad_start(ifa,
2355                             arc4random() % (MAX_RTR_SOLICITATION_DELAY * hz));
2356                 }
2357         }
2358         IF_ADDR_RUNLOCK(ifp);
2359
2360         /*
2361          * special cases, like 6to4, are handled in in6_ifattach
2362          */
2363         in6_ifattach(ifp, NULL);
2364 }
2365
2366 int
2367 in6if_do_dad(struct ifnet *ifp)
2368 {
2369         if ((ifp->if_flags & IFF_LOOPBACK) != 0)
2370                 return (0);
2371
2372         if ((ND_IFINFO(ifp)->flags & ND6_IFF_IFDISABLED) ||
2373             (ND_IFINFO(ifp)->flags & ND6_IFF_NO_DAD))
2374                 return (0);
2375
2376         switch (ifp->if_type) {
2377 #ifdef IFT_DUMMY
2378         case IFT_DUMMY:
2379 #endif
2380         case IFT_FAITH:
2381                 /*
2382                  * These interfaces do not have the IFF_LOOPBACK flag,
2383                  * but loop packets back.  We do not have to do DAD on such
2384                  * interfaces.  We should even omit it, because loop-backed
2385                  * NS would confuse the DAD procedure.
2386                  */
2387                 return (0);
2388         default:
2389                 /*
2390                  * Our DAD routine requires the interface up and running.
2391                  * However, some interfaces can be up before the RUNNING
2392                  * status.  Additionaly, users may try to assign addresses
2393                  * before the interface becomes up (or running).
2394                  * We simply skip DAD in such a case as a work around.
2395                  * XXX: we should rather mark "tentative" on such addresses,
2396                  * and do DAD after the interface becomes ready.
2397                  */
2398                 if (!((ifp->if_flags & IFF_UP) &&
2399                     (ifp->if_drv_flags & IFF_DRV_RUNNING)))
2400                         return (0);
2401
2402                 return (1);
2403         }
2404 }
2405
2406 /*
2407  * Calculate max IPv6 MTU through all the interfaces and store it
2408  * to in6_maxmtu.
2409  */
2410 void
2411 in6_setmaxmtu(void)
2412 {
2413         unsigned long maxmtu = 0;
2414         struct ifnet *ifp;
2415
2416         IFNET_RLOCK_NOSLEEP();
2417         TAILQ_FOREACH(ifp, &V_ifnet, if_list) {
2418                 /* this function can be called during ifnet initialization */
2419                 if (!ifp->if_afdata[AF_INET6])
2420                         continue;
2421                 if ((ifp->if_flags & IFF_LOOPBACK) == 0 &&
2422                     IN6_LINKMTU(ifp) > maxmtu)
2423                         maxmtu = IN6_LINKMTU(ifp);
2424         }
2425         IFNET_RUNLOCK_NOSLEEP();
2426         if (maxmtu)     /* update only when maxmtu is positive */
2427                 V_in6_maxmtu = maxmtu;
2428 }
2429
2430 /*
2431  * Provide the length of interface identifiers to be used for the link attached
2432  * to the given interface.  The length should be defined in "IPv6 over
2433  * xxx-link" document.  Note that address architecture might also define
2434  * the length for a particular set of address prefixes, regardless of the
2435  * link type.  As clarified in rfc2462bis, those two definitions should be
2436  * consistent, and those really are as of August 2004.
2437  */
2438 int
2439 in6_if2idlen(struct ifnet *ifp)
2440 {
2441         switch (ifp->if_type) {
2442         case IFT_ETHER:         /* RFC2464 */
2443 #ifdef IFT_PROPVIRTUAL
2444         case IFT_PROPVIRTUAL:   /* XXX: no RFC. treat it as ether */
2445 #endif
2446 #ifdef IFT_L2VLAN
2447         case IFT_L2VLAN:        /* ditto */
2448 #endif
2449 #ifdef IFT_IEEE80211
2450         case IFT_IEEE80211:     /* ditto */
2451 #endif
2452 #ifdef IFT_MIP
2453         case IFT_MIP:   /* ditto */
2454 #endif
2455         case IFT_INFINIBAND:
2456                 return (64);
2457         case IFT_FDDI:          /* RFC2467 */
2458                 return (64);
2459         case IFT_ISO88025:      /* RFC2470 (IPv6 over Token Ring) */
2460                 return (64);
2461         case IFT_PPP:           /* RFC2472 */
2462                 return (64);
2463         case IFT_ARCNET:        /* RFC2497 */
2464                 return (64);
2465         case IFT_FRELAY:        /* RFC2590 */
2466                 return (64);
2467         case IFT_IEEE1394:      /* RFC3146 */
2468                 return (64);
2469         case IFT_GIF:
2470                 return (64);    /* draft-ietf-v6ops-mech-v2-07 */
2471         case IFT_LOOP:
2472                 return (64);    /* XXX: is this really correct? */
2473         default:
2474                 /*
2475                  * Unknown link type:
2476                  * It might be controversial to use the today's common constant
2477                  * of 64 for these cases unconditionally.  For full compliance,
2478                  * we should return an error in this case.  On the other hand,
2479                  * if we simply miss the standard for the link type or a new
2480                  * standard is defined for a new link type, the IFID length
2481                  * is very likely to be the common constant.  As a compromise,
2482                  * we always use the constant, but make an explicit notice
2483                  * indicating the "unknown" case.
2484                  */
2485                 printf("in6_if2idlen: unknown link type (%d)\n", ifp->if_type);
2486                 return (64);
2487         }
2488 }
2489
2490 #include <sys/sysctl.h>
2491
2492 struct in6_llentry {
2493         struct llentry          base;
2494         struct sockaddr_in6     l3_addr6;
2495 };
2496
2497 /*
2498  * Deletes an address from the address table.
2499  * This function is called by the timer functions
2500  * such as arptimer() and nd6_llinfo_timer(), and
2501  * the caller does the locking.
2502  */
2503 static void
2504 in6_lltable_free(struct lltable *llt, struct llentry *lle)
2505 {
2506         LLE_WUNLOCK(lle);
2507         LLE_LOCK_DESTROY(lle);
2508         free(lle, M_LLTABLE);
2509 }
2510
2511 static struct llentry *
2512 in6_lltable_new(const struct sockaddr *l3addr, u_int flags)
2513 {
2514         struct in6_llentry *lle;
2515
2516         lle = malloc(sizeof(struct in6_llentry), M_LLTABLE, M_NOWAIT | M_ZERO);
2517         if (lle == NULL)                /* NB: caller generates msg */
2518                 return NULL;
2519
2520         lle->l3_addr6 = *(const struct sockaddr_in6 *)l3addr;
2521         lle->base.lle_refcnt = 1;
2522         lle->base.lle_free = in6_lltable_free;
2523         LLE_LOCK_INIT(&lle->base);
2524         callout_init(&lle->base.ln_timer_ch, 1);
2525
2526         return (&lle->base);
2527 }
2528
2529 static void
2530 in6_lltable_prefix_free(struct lltable *llt, const struct sockaddr *prefix,
2531     const struct sockaddr *mask, u_int flags)
2532 {
2533         const struct sockaddr_in6 *pfx = (const struct sockaddr_in6 *)prefix;
2534         const struct sockaddr_in6 *msk = (const struct sockaddr_in6 *)mask;
2535         struct llentry *lle, *next;
2536         int i;
2537
2538         /*
2539          * (flags & LLE_STATIC) means deleting all entries
2540          * including static ND6 entries.
2541          */
2542         IF_AFDATA_WLOCK(llt->llt_ifp);
2543         for (i = 0; i < LLTBL_HASHTBL_SIZE; i++) {
2544                 LIST_FOREACH_SAFE(lle, &llt->lle_head[i], lle_next, next) {
2545                         if (IN6_ARE_MASKED_ADDR_EQUAL(
2546                             &satosin6(L3_ADDR(lle))->sin6_addr,
2547                             &pfx->sin6_addr, &msk->sin6_addr) &&
2548                             ((flags & LLE_STATIC) ||
2549                             !(lle->la_flags & LLE_STATIC))) {
2550                                 LLE_WLOCK(lle);
2551                                 if (callout_stop(&lle->la_timer))
2552                                         LLE_REMREF(lle);
2553                                 llentry_free(lle);
2554                         }
2555                 }
2556         }
2557         IF_AFDATA_WUNLOCK(llt->llt_ifp);
2558 }
2559
2560 static int
2561 in6_lltable_rtcheck(struct ifnet *ifp,
2562                     u_int flags,
2563                     const struct sockaddr *l3addr)
2564 {
2565         struct rtentry *rt;
2566         char ip6buf[INET6_ADDRSTRLEN];
2567
2568         KASSERT(l3addr->sa_family == AF_INET6,
2569             ("sin_family %d", l3addr->sa_family));
2570
2571         /* Our local addresses are always only installed on the default FIB. */
2572         /* XXX rtalloc1 should take a const param */
2573         rt = in6_rtalloc1(__DECONST(struct sockaddr *, l3addr), 0, 0,
2574             RT_DEFAULT_FIB);
2575         if (rt == NULL || (rt->rt_flags & RTF_GATEWAY) || rt->rt_ifp != ifp) {
2576                 struct ifaddr *ifa;
2577                 /*
2578                  * Create an ND6 cache for an IPv6 neighbor
2579                  * that is not covered by our own prefix.
2580                  */
2581                 /* XXX ifaof_ifpforaddr should take a const param */
2582                 ifa = ifaof_ifpforaddr(__DECONST(struct sockaddr *, l3addr), ifp);
2583                 if (ifa != NULL) {
2584                         ifa_free(ifa);
2585                         if (rt != NULL)
2586                                 RTFREE_LOCKED(rt);
2587                         return 0;
2588                 }
2589                 log(LOG_INFO, "IPv6 address: \"%s\" is not on the network\n",
2590                     ip6_sprintf(ip6buf, &((const struct sockaddr_in6 *)l3addr)->sin6_addr));
2591                 if (rt != NULL)
2592                         RTFREE_LOCKED(rt);
2593                 return EINVAL;
2594         }
2595         RTFREE_LOCKED(rt);
2596         return 0;
2597 }
2598
2599 static struct llentry *
2600 in6_lltable_lookup(struct lltable *llt, u_int flags,
2601         const struct sockaddr *l3addr)
2602 {
2603         const struct sockaddr_in6 *sin6 = (const struct sockaddr_in6 *)l3addr;
2604         struct ifnet *ifp = llt->llt_ifp;
2605         struct llentry *lle;
2606         struct llentries *lleh;
2607         u_int hashkey;
2608
2609         IF_AFDATA_LOCK_ASSERT(ifp);
2610         KASSERT(l3addr->sa_family == AF_INET6,
2611             ("sin_family %d", l3addr->sa_family));
2612
2613         hashkey = sin6->sin6_addr.s6_addr32[3];
2614         lleh = &llt->lle_head[LLATBL_HASH(hashkey, LLTBL_HASHMASK)];
2615         LIST_FOREACH(lle, lleh, lle_next) {
2616                 struct sockaddr_in6 *sa6 = (struct sockaddr_in6 *)L3_ADDR(lle);
2617                 if (lle->la_flags & LLE_DELETED)
2618                         continue;
2619                 if (bcmp(&sa6->sin6_addr, &sin6->sin6_addr,
2620                     sizeof(struct in6_addr)) == 0)
2621                         break;
2622         }
2623
2624         if (lle == NULL) {
2625                 if (!(flags & LLE_CREATE))
2626                         return (NULL);
2627                 IF_AFDATA_WLOCK_ASSERT(ifp);
2628                 /*
2629                  * A route that covers the given address must have
2630                  * been installed 1st because we are doing a resolution,
2631                  * verify this.
2632                  */
2633                 if (!(flags & LLE_IFADDR) &&
2634                     in6_lltable_rtcheck(ifp, flags, l3addr) != 0)
2635                         return NULL;
2636
2637                 lle = in6_lltable_new(l3addr, flags);
2638                 if (lle == NULL) {
2639                         log(LOG_INFO, "lla_lookup: new lle malloc failed\n");
2640                         return NULL;
2641                 }
2642                 lle->la_flags = flags & ~LLE_CREATE;
2643                 if ((flags & (LLE_CREATE | LLE_IFADDR)) == (LLE_CREATE | LLE_IFADDR)) {
2644                         bcopy(IF_LLADDR(ifp), &lle->ll_addr, ifp->if_addrlen);
2645                         lle->la_flags |= (LLE_VALID | LLE_STATIC);
2646                 }
2647
2648                 lle->lle_tbl  = llt;
2649                 lle->lle_head = lleh;
2650                 lle->la_flags |= LLE_LINKED;
2651                 LIST_INSERT_HEAD(lleh, lle, lle_next);
2652         } else if (flags & LLE_DELETE) {
2653                 if (!(lle->la_flags & LLE_IFADDR) || (flags & LLE_IFADDR)) {
2654                         LLE_WLOCK(lle);
2655                         lle->la_flags |= LLE_DELETED;
2656 #ifdef DIAGNOSTIC
2657                         log(LOG_INFO, "ifaddr cache = %p is deleted\n", lle);
2658 #endif
2659                         if ((lle->la_flags &
2660                             (LLE_STATIC | LLE_IFADDR)) == LLE_STATIC)
2661                                 llentry_free(lle);
2662                         else
2663                                 LLE_WUNLOCK(lle);
2664                 }
2665                 lle = (void *)-1;
2666         }
2667         if (LLE_IS_VALID(lle)) {
2668                 if (flags & LLE_EXCLUSIVE)
2669                         LLE_WLOCK(lle);
2670                 else
2671                         LLE_RLOCK(lle);
2672         }
2673         return (lle);
2674 }
2675
2676 static int
2677 in6_lltable_dump(struct lltable *llt, struct sysctl_req *wr)
2678 {
2679         struct ifnet *ifp = llt->llt_ifp;
2680         struct llentry *lle;
2681         /* XXX stack use */
2682         struct {
2683                 struct rt_msghdr        rtm;
2684                 struct sockaddr_in6     sin6;
2685                 /*
2686                  * ndp.c assumes that sdl is word aligned
2687                  */
2688 #ifdef __LP64__
2689                 uint32_t                pad;
2690 #endif
2691                 struct sockaddr_dl      sdl;
2692         } ndpc;
2693         int i, error;
2694
2695         if (ifp->if_flags & IFF_LOOPBACK)
2696                 return 0;
2697
2698         LLTABLE_LOCK_ASSERT();
2699
2700         error = 0;
2701         for (i = 0; i < LLTBL_HASHTBL_SIZE; i++) {
2702                 LIST_FOREACH(lle, &llt->lle_head[i], lle_next) {
2703                         struct sockaddr_dl *sdl;
2704
2705                         /* skip deleted or invalid entries */
2706                         if ((lle->la_flags & (LLE_DELETED|LLE_VALID)) != LLE_VALID)
2707                                 continue;
2708                         /* Skip if jailed and not a valid IP of the prison. */
2709                         if (prison_if(wr->td->td_ucred, L3_ADDR(lle)) != 0)
2710                                 continue;
2711                         /*
2712                          * produce a msg made of:
2713                          *  struct rt_msghdr;
2714                          *  struct sockaddr_in6 (IPv6)
2715                          *  struct sockaddr_dl;
2716                          */
2717                         bzero(&ndpc, sizeof(ndpc));
2718                         ndpc.rtm.rtm_msglen = sizeof(ndpc);
2719                         ndpc.rtm.rtm_version = RTM_VERSION;
2720                         ndpc.rtm.rtm_type = RTM_GET;
2721                         ndpc.rtm.rtm_flags = RTF_UP;
2722                         ndpc.rtm.rtm_addrs = RTA_DST | RTA_GATEWAY;
2723                         ndpc.sin6.sin6_family = AF_INET6;
2724                         ndpc.sin6.sin6_len = sizeof(ndpc.sin6);
2725                         bcopy(L3_ADDR(lle), &ndpc.sin6, L3_ADDR_LEN(lle));
2726                         if (V_deembed_scopeid)
2727                                 sa6_recoverscope(&ndpc.sin6);
2728
2729                         /* publish */
2730                         if (lle->la_flags & LLE_PUB)
2731                                 ndpc.rtm.rtm_flags |= RTF_ANNOUNCE;
2732
2733                         sdl = &ndpc.sdl;
2734                         sdl->sdl_family = AF_LINK;
2735                         sdl->sdl_len = sizeof(*sdl);
2736                         sdl->sdl_alen = ifp->if_addrlen;
2737                         sdl->sdl_index = ifp->if_index;
2738                         sdl->sdl_type = ifp->if_type;
2739                         bcopy(&lle->ll_addr, LLADDR(sdl), ifp->if_addrlen);
2740                         ndpc.rtm.rtm_rmx.rmx_expire =
2741                             lle->la_flags & LLE_STATIC ? 0 : lle->la_expire;
2742                         ndpc.rtm.rtm_flags |= (RTF_HOST | RTF_LLDATA);
2743                         if (lle->la_flags & LLE_STATIC)
2744                                 ndpc.rtm.rtm_flags |= RTF_STATIC;
2745                         ndpc.rtm.rtm_index = ifp->if_index;
2746                         error = SYSCTL_OUT(wr, &ndpc, sizeof(ndpc));
2747                         if (error)
2748                                 break;
2749                 }
2750         }
2751         return error;
2752 }
2753
2754 void *
2755 in6_domifattach(struct ifnet *ifp)
2756 {
2757         struct in6_ifextra *ext;
2758
2759         /* There are not IPv6-capable interfaces. */
2760         switch (ifp->if_type) {
2761         case IFT_PFLOG:
2762         case IFT_PFSYNC:
2763         case IFT_USB:
2764                 return (NULL);
2765         }
2766         ext = (struct in6_ifextra *)malloc(sizeof(*ext), M_IFADDR, M_WAITOK);
2767         bzero(ext, sizeof(*ext));
2768
2769         ext->in6_ifstat = malloc(sizeof(counter_u64_t) *
2770             sizeof(struct in6_ifstat) / sizeof(uint64_t), M_IFADDR, M_WAITOK);
2771         COUNTER_ARRAY_ALLOC(ext->in6_ifstat,
2772             sizeof(struct in6_ifstat) / sizeof(uint64_t), M_WAITOK);
2773
2774         ext->icmp6_ifstat = malloc(sizeof(counter_u64_t) *
2775             sizeof(struct icmp6_ifstat) / sizeof(uint64_t), M_IFADDR,
2776             M_WAITOK);
2777         COUNTER_ARRAY_ALLOC(ext->icmp6_ifstat,
2778             sizeof(struct icmp6_ifstat) / sizeof(uint64_t), M_WAITOK);
2779
2780         ext->nd_ifinfo = nd6_ifattach(ifp);
2781         ext->scope6_id = scope6_ifattach(ifp);
2782         ext->lltable = lltable_init(ifp, AF_INET6);
2783         if (ext->lltable != NULL) {
2784                 ext->lltable->llt_prefix_free = in6_lltable_prefix_free;
2785                 ext->lltable->llt_lookup = in6_lltable_lookup;
2786                 ext->lltable->llt_dump = in6_lltable_dump;
2787         }
2788
2789         ext->mld_ifinfo = mld_domifattach(ifp);
2790
2791         return ext;
2792 }
2793
2794 void
2795 in6_domifdetach(struct ifnet *ifp, void *aux)
2796 {
2797         struct in6_ifextra *ext = (struct in6_ifextra *)aux;
2798
2799         mld_domifdetach(ifp);
2800         scope6_ifdetach(ext->scope6_id);
2801         nd6_ifdetach(ext->nd_ifinfo);
2802         lltable_free(ext->lltable);
2803         COUNTER_ARRAY_FREE(ext->in6_ifstat,
2804             sizeof(struct in6_ifstat) / sizeof(uint64_t));
2805         free(ext->in6_ifstat, M_IFADDR);
2806         COUNTER_ARRAY_FREE(ext->icmp6_ifstat,
2807             sizeof(struct icmp6_ifstat) / sizeof(uint64_t));
2808         free(ext->icmp6_ifstat, M_IFADDR);
2809         free(ext, M_IFADDR);
2810 }
2811
2812 /*
2813  * Convert sockaddr_in6 to sockaddr_in.  Original sockaddr_in6 must be
2814  * v4 mapped addr or v4 compat addr
2815  */
2816 void
2817 in6_sin6_2_sin(struct sockaddr_in *sin, struct sockaddr_in6 *sin6)
2818 {
2819
2820         bzero(sin, sizeof(*sin));
2821         sin->sin_len = sizeof(struct sockaddr_in);
2822         sin->sin_family = AF_INET;
2823         sin->sin_port = sin6->sin6_port;
2824         sin->sin_addr.s_addr = sin6->sin6_addr.s6_addr32[3];
2825 }
2826
2827 /* Convert sockaddr_in to sockaddr_in6 in v4 mapped addr format. */
2828 void
2829 in6_sin_2_v4mapsin6(struct sockaddr_in *sin, struct sockaddr_in6 *sin6)
2830 {
2831         bzero(sin6, sizeof(*sin6));
2832         sin6->sin6_len = sizeof(struct sockaddr_in6);
2833         sin6->sin6_family = AF_INET6;
2834         sin6->sin6_port = sin->sin_port;
2835         sin6->sin6_addr.s6_addr32[0] = 0;
2836         sin6->sin6_addr.s6_addr32[1] = 0;
2837         sin6->sin6_addr.s6_addr32[2] = IPV6_ADDR_INT32_SMP;
2838         sin6->sin6_addr.s6_addr32[3] = sin->sin_addr.s_addr;
2839 }
2840
2841 /* Convert sockaddr_in6 into sockaddr_in. */
2842 void
2843 in6_sin6_2_sin_in_sock(struct sockaddr *nam)
2844 {
2845         struct sockaddr_in *sin_p;
2846         struct sockaddr_in6 sin6;
2847
2848         /*
2849          * Save original sockaddr_in6 addr and convert it
2850          * to sockaddr_in.
2851          */
2852         sin6 = *(struct sockaddr_in6 *)nam;
2853         sin_p = (struct sockaddr_in *)nam;
2854         in6_sin6_2_sin(sin_p, &sin6);
2855 }
2856
2857 /* Convert sockaddr_in into sockaddr_in6 in v4 mapped addr format. */
2858 void
2859 in6_sin_2_v4mapsin6_in_sock(struct sockaddr **nam)
2860 {
2861         struct sockaddr_in *sin_p;
2862         struct sockaddr_in6 *sin6_p;
2863
2864         sin6_p = malloc(sizeof *sin6_p, M_SONAME, M_WAITOK);
2865         sin_p = (struct sockaddr_in *)*nam;
2866         in6_sin_2_v4mapsin6(sin_p, sin6_p);
2867         free(*nam, M_SONAME);
2868         *nam = (struct sockaddr *)sin6_p;
2869 }