sys/netinet6/nd6_nbr.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: nd6_nbr.c,v 1.86 2002/01/21 02:33:04 jinmei Exp $
  30  */
  31
  32 #include <sys/cdefs.h>
  33 __FBSDID("$FreeBSD$");
  34
  35 #include "opt_inet.h"
  36 #include "opt_inet6.h"
  37 #include "opt_ipsec.h"
  38 #include "opt_mpath.h"
  39
  40 #include <sys/param.h>
  41 #include <sys/systm.h>
  42 #include <sys/malloc.h>
  43 #include <sys/lock.h>
  44 #include <sys/rwlock.h>
  45 #include <sys/mbuf.h>
  46 #include <sys/socket.h>
  47 #include <sys/sockio.h>
  48 #include <sys/time.h>
  49 #include <sys/kernel.h>
  50 #include <sys/errno.h>
  51 #include <sys/syslog.h>
  52 #include <sys/queue.h>
  53 #include <sys/callout.h>
  54
  55 #include <net/if.h>
  56 #include <net/if_types.h>
  57 #include <net/if_dl.h>
  58 #include <net/if_var.h>
  59 #include <net/route.h>
  60 #ifdef RADIX_MPATH
  61 #include <net/radix_mpath.h>
  62 #endif
  63
  64 #include <netinet/in.h>
  65 #include <netinet/in_var.h>
  66 #include <net/if_llatbl.h>
  67 #define L3_ADDR_SIN6(le)        ((struct sockaddr_in6 *) L3_ADDR(le))
  68 #include <netinet6/in6_var.h>
  69 #include <netinet6/in6_ifattach.h>
  70 #include <netinet/ip6.h>
  71 #include <netinet6/ip6_var.h>
  72 #include <netinet6/scope6_var.h>
  73 #include <netinet6/nd6.h>
  74 #include <netinet/icmp6.h>
  75 #include <netinet/ip_carp.h>
  76 #include <netinet6/send.h>
  77
  78 #define SDL(s) ((struct sockaddr_dl *)s)
  79
  80 struct dadq;
  81 static struct dadq *nd6_dad_find(struct ifaddr *);
  82 static void nd6_dad_starttimer(struct dadq *, int);
  83 static void nd6_dad_stoptimer(struct dadq *);
  84 static void nd6_dad_timer(struct dadq *);
  85 static void nd6_dad_ns_output(struct dadq *, struct ifaddr *);
  86 static void nd6_dad_ns_input(struct ifaddr *);
  87 static void nd6_dad_na_input(struct ifaddr *);
  88 static void nd6_na_output_fib(struct ifnet *, const struct in6_addr *,
  89     const struct in6_addr *, u_long, int, struct sockaddr *, u_int);
  90
  91 VNET_DEFINE(int, dad_ignore_ns) = 0;    /* ignore NS in DAD - specwise incorrect*/
  92 VNET_DEFINE(int, dad_maxtry) = 15;      /* max # of *tries* to transmit DAD packet */
  93 #define V_dad_ignore_ns                 VNET(dad_ignore_ns)
  94 #define V_dad_maxtry                    VNET(dad_maxtry)
  95
  96 /*
  97  * Input a Neighbor Solicitation Message.
  98  *
  99  * Based on RFC 2461
 100  * Based on RFC 2462 (duplicate address detection)
 101  */
 102 void
 103 nd6_ns_input(struct mbuf *m, int off, int icmp6len)
 104 {
 105         struct ifnet *ifp = m->m_pkthdr.rcvif;
 106         struct ip6_hdr *ip6 = mtod(m, struct ip6_hdr *);
 107         struct nd_neighbor_solicit *nd_ns;
 108         struct in6_addr saddr6 = ip6->ip6_src;
 109         struct in6_addr daddr6 = ip6->ip6_dst;
 110         struct in6_addr taddr6;
 111         struct in6_addr myaddr6;
 112         char *lladdr = NULL;
 113         struct ifaddr *ifa = NULL;
 114         int lladdrlen = 0;
 115         int anycast = 0, proxy = 0, tentative = 0;
 116         int tlladdr;
 117         int rflag;
 118         union nd_opts ndopts;
 119         struct sockaddr_dl proxydl;
 120         char ip6bufs[INET6_ADDRSTRLEN], ip6bufd[INET6_ADDRSTRLEN];
 121
 122         rflag = (V_ip6_forwarding) ? ND_NA_FLAG_ROUTER : 0;
 123         if (ND_IFINFO(ifp)->flags & ND6_IFF_ACCEPT_RTADV && V_ip6_norbit_raif)
 124                 rflag = 0;
 125 #ifndef PULLDOWN_TEST
 126         IP6_EXTHDR_CHECK(m, off, icmp6len,);
 127         nd_ns = (struct nd_neighbor_solicit *)((caddr_t)ip6 + off);
 128 #else
 129         IP6_EXTHDR_GET(nd_ns, struct nd_neighbor_solicit *, m, off, icmp6len);
 130         if (nd_ns == NULL) {
 131                 ICMP6STAT_INC(icp6s_tooshort);
 132                 return;
 133         }
 134 #endif
 135         ip6 = mtod(m, struct ip6_hdr *); /* adjust pointer for safety */
 136         taddr6 = nd_ns->nd_ns_target;
 137         if (in6_setscope(&taddr6, ifp, NULL) != 0)
 138                 goto bad;
 139
 140         if (ip6->ip6_hlim != 255) {
 141                 nd6log((LOG_ERR,
 142                     "nd6_ns_input: invalid hlim (%d) from %s to %s on %s\n",
 143                     ip6->ip6_hlim, ip6_sprintf(ip6bufs, &ip6->ip6_src),
 144                     ip6_sprintf(ip6bufd, &ip6->ip6_dst), if_name(ifp)));
 145                 goto bad;
 146         }
 147
 148         if (IN6_IS_ADDR_UNSPECIFIED(&saddr6)) {
 149                 /* dst has to be a solicited node multicast address. */
 150                 if (daddr6.s6_addr16[0] == IPV6_ADDR_INT16_MLL &&
 151                     /* don't check ifindex portion */
 152                     daddr6.s6_addr32[1] == 0 &&
 153                     daddr6.s6_addr32[2] == IPV6_ADDR_INT32_ONE &&
 154                     daddr6.s6_addr8[12] == 0xff) {
 155                         ; /* good */
 156                 } else {
 157                         nd6log((LOG_INFO, "nd6_ns_input: bad DAD packet "
 158                             "(wrong ip6 dst)\n"));
 159                         goto bad;
 160                 }
 161         } else if (!V_nd6_onlink_ns_rfc4861) {
 162                 struct sockaddr_in6 src_sa6;
 163
 164                 /*
 165                  * According to recent IETF discussions, it is not a good idea
 166                  * to accept a NS from an address which would not be deemed
 167                  * to be a neighbor otherwise.  This point is expected to be
 168                  * clarified in future revisions of the specification.
 169                  */
 170                 bzero(&src_sa6, sizeof(src_sa6));
 171                 src_sa6.sin6_family = AF_INET6;
 172                 src_sa6.sin6_len = sizeof(src_sa6);
 173                 src_sa6.sin6_addr = saddr6;
 174                 if (nd6_is_addr_neighbor(&src_sa6, ifp) == 0) {
 175                         nd6log((LOG_INFO, "nd6_ns_input: "
 176                                 "NS packet from non-neighbor\n"));
 177                         goto bad;
 178                 }
 179         }
 180
 181         if (IN6_IS_ADDR_MULTICAST(&taddr6)) {
 182                 nd6log((LOG_INFO, "nd6_ns_input: bad NS target (multicast)\n"));
 183                 goto bad;
 184         }
 185
 186         icmp6len -= sizeof(*nd_ns);
 187         nd6_option_init(nd_ns + 1, icmp6len, &ndopts);
 188         if (nd6_options(&ndopts) < 0) {
 189                 nd6log((LOG_INFO,
 190                     "nd6_ns_input: invalid ND option, ignored\n"));
 191                 /* nd6_options have incremented stats */
 192                 goto freeit;
 193         }
 194
 195         if (ndopts.nd_opts_src_lladdr) {
 196                 lladdr = (char *)(ndopts.nd_opts_src_lladdr + 1);
 197                 lladdrlen = ndopts.nd_opts_src_lladdr->nd_opt_len << 3;
 198         }
 199
 200         if (IN6_IS_ADDR_UNSPECIFIED(&ip6->ip6_src) && lladdr) {
 201                 nd6log((LOG_INFO, "nd6_ns_input: bad DAD packet "
 202                     "(link-layer address option)\n"));
 203                 goto bad;
 204         }
 205
 206         /*
 207          * Attaching target link-layer address to the NA?
 208          * (RFC 2461 7.2.4)
 209          *
 210          * NS IP dst is unicast/anycast                 MUST NOT add
 211          * NS IP dst is solicited-node multicast        MUST add
 212          *
 213          * In implementation, we add target link-layer address by default.
 214          * We do not add one in MUST NOT cases.
 215          */
 216         if (!IN6_IS_ADDR_MULTICAST(&daddr6))
 217                 tlladdr = 0;
 218         else
 219                 tlladdr = 1;
 220
 221         /*
 222          * Target address (taddr6) must be either:
 223          * (1) Valid unicast/anycast address for my receiving interface,
 224          * (2) Unicast address for which I'm offering proxy service, or
 225          * (3) "tentative" address on which DAD is being performed.
 226          */
 227         /* (1) and (3) check. */
 228         if (ifp->if_carp)
 229                 ifa = (*carp_iamatch6_p)(ifp, &taddr6);
 230         else
 231                 ifa = (struct ifaddr *)in6ifa_ifpwithaddr(ifp, &taddr6);
 232
 233         /* (2) check. */
 234         if (ifa == NULL) {
 235                 struct rtentry *rt;
 236                 struct sockaddr_in6 tsin6;
 237                 int need_proxy;
 238 #ifdef RADIX_MPATH
 239                 struct route_in6 ro;
 240 #endif
 241
 242                 bzero(&tsin6, sizeof tsin6);
 243                 tsin6.sin6_len = sizeof(struct sockaddr_in6);
 244                 tsin6.sin6_family = AF_INET6;
 245                 tsin6.sin6_addr = taddr6;
 246
 247                 /* Always use the default FIB. */
 248 #ifdef RADIX_MPATH
 249                 bzero(&ro, sizeof(ro));
 250                 ro.ro_dst = tsin6;
 251                 rtalloc_mpath_fib((struct route *)&ro, RTF_ANNOUNCE,
 252                     RT_DEFAULT_FIB);
 253                 rt = ro.ro_rt;
 254 #else
 255                 rt = in6_rtalloc1((struct sockaddr *)&tsin6, 0, 0,
 256                     RT_DEFAULT_FIB);
 257 #endif
 258                 need_proxy = (rt && (rt->rt_flags & RTF_ANNOUNCE) != 0 &&
 259                     rt->rt_gateway->sa_family == AF_LINK);
 260                 if (rt != NULL) {
 261                         /*
 262                          * Make a copy while we can be sure that rt_gateway
 263                          * is still stable before unlocking to avoid lock
 264                          * order problems.  proxydl will only be used if
 265                          * proxy will be set in the next block.
 266                          */
 267                         if (need_proxy)
 268                                 proxydl = *SDL(rt->rt_gateway);
 269                         RTFREE_LOCKED(rt);
 270                 }
 271                 if (need_proxy) {
 272                         /*
 273                          * proxy NDP for single entry
 274                          */
 275                         ifa = (struct ifaddr *)in6ifa_ifpforlinklocal(ifp,
 276                                 IN6_IFF_NOTREADY|IN6_IFF_ANYCAST);
 277                         if (ifa)
 278                                 proxy = 1;
 279                 }
 280         }
 281         if (ifa == NULL) {
 282                 /*
 283                  * We've got an NS packet, and we don't have that adddress
 284                  * assigned for us.  We MUST silently ignore it.
 285                  * See RFC2461 7.2.3.
 286                  */
 287                 goto freeit;
 288         }
 289         myaddr6 = *IFA_IN6(ifa);
 290         anycast = ((struct in6_ifaddr *)ifa)->ia6_flags & IN6_IFF_ANYCAST;
 291         tentative = ((struct in6_ifaddr *)ifa)->ia6_flags & IN6_IFF_TENTATIVE;
 292         if (((struct in6_ifaddr *)ifa)->ia6_flags & IN6_IFF_DUPLICATED)
 293                 goto freeit;
 294
 295         if (lladdr && ((ifp->if_addrlen + 2 + 7) & ~7) != lladdrlen) {
 296                 nd6log((LOG_INFO, "nd6_ns_input: lladdrlen mismatch for %s "
 297                     "(if %d, NS packet %d)\n",
 298                     ip6_sprintf(ip6bufs, &taddr6),
 299                     ifp->if_addrlen, lladdrlen - 2));
 300                 goto bad;
 301         }
 302
 303         if (IN6_ARE_ADDR_EQUAL(&myaddr6, &saddr6)) {
 304                 nd6log((LOG_INFO, "nd6_ns_input: duplicate IP6 address %s\n",
 305                     ip6_sprintf(ip6bufs, &saddr6)));
 306                 goto freeit;
 307         }
 308
 309         /*
 310          * We have neighbor solicitation packet, with target address equals to
 311          * one of my tentative address.
 312          *
 313          * src addr     how to process?
 314          * ---          ---
 315          * multicast    of course, invalid (rejected in ip6_input)
 316          * unicast      somebody is doing address resolution -> ignore
 317          * unspec       dup address detection
 318          *
 319          * The processing is defined in RFC 2462.
 320          */
 321         if (tentative) {
 322                 /*
 323                  * If source address is unspecified address, it is for
 324                  * duplicate address detection.
 325                  *
 326                  * If not, the packet is for addess resolution;
 327                  * silently ignore it.
 328                  */
 329                 if (IN6_IS_ADDR_UNSPECIFIED(&saddr6))
 330                         nd6_dad_ns_input(ifa);
 331
 332                 goto freeit;
 333         }
 334
 335         /*
 336          * If the source address is unspecified address, entries must not
 337          * be created or updated.
 338          * It looks that sender is performing DAD.  Output NA toward
 339          * all-node multicast address, to tell the sender that I'm using
 340          * the address.
 341          * S bit ("solicited") must be zero.
 342          */
 343         if (IN6_IS_ADDR_UNSPECIFIED(&saddr6)) {
 344                 struct in6_addr in6_all;
 345
 346                 in6_all = in6addr_linklocal_allnodes;
 347                 if (in6_setscope(&in6_all, ifp, NULL) != 0)
 348                         goto bad;
 349                 nd6_na_output_fib(ifp, &in6_all, &taddr6,
 350                     ((anycast || proxy || !tlladdr) ? 0 : ND_NA_FLAG_OVERRIDE) |
 351                     rflag, tlladdr, proxy ? (struct sockaddr *)&proxydl : NULL,
 352                     M_GETFIB(m));
 353                 goto freeit;
 354         }
 355
 356         nd6_cache_lladdr(ifp, &saddr6, lladdr, lladdrlen,
 357             ND_NEIGHBOR_SOLICIT, 0);
 358
 359         nd6_na_output_fib(ifp, &saddr6, &taddr6,
 360             ((anycast || proxy || !tlladdr) ? 0 : ND_NA_FLAG_OVERRIDE) |
 361             rflag | ND_NA_FLAG_SOLICITED, tlladdr,
 362             proxy ? (struct sockaddr *)&proxydl : NULL, M_GETFIB(m));
 363  freeit:
 364         if (ifa != NULL)
 365                 ifa_free(ifa);
 366         m_freem(m);
 367         return;
 368
 369  bad:
 370         nd6log((LOG_ERR, "nd6_ns_input: src=%s\n",
 371                 ip6_sprintf(ip6bufs, &saddr6)));
 372         nd6log((LOG_ERR, "nd6_ns_input: dst=%s\n",
 373                 ip6_sprintf(ip6bufs, &daddr6)));
 374         nd6log((LOG_ERR, "nd6_ns_input: tgt=%s\n",
 375                 ip6_sprintf(ip6bufs, &taddr6)));
 376         ICMP6STAT_INC(icp6s_badns);
 377         if (ifa != NULL)
 378                 ifa_free(ifa);
 379         m_freem(m);
 380 }
 381
 382 /*
 383  * Output a Neighbor Solicitation Message. Caller specifies:
 384  *      - ICMP6 header source IP6 address
 385  *      - ND6 header target IP6 address
 386  *      - ND6 header source datalink address
 387  *
 388  * Based on RFC 2461
 389  * Based on RFC 2462 (duplicate address detection)
 390  *
 391  *   ln - for source address determination
 392  *  dad - duplicate address detection
 393  */
 394 void
 395 nd6_ns_output(struct ifnet *ifp, const struct in6_addr *daddr6,
 396     const struct in6_addr *taddr6, struct llentry *ln, int dad)
 397 {
 398         struct mbuf *m;
 399         struct m_tag *mtag;
 400         struct ip6_hdr *ip6;
 401         struct nd_neighbor_solicit *nd_ns;
 402         struct ip6_moptions im6o;
 403         int icmp6len;
 404         int maxlen;
 405         caddr_t mac;
 406         struct route_in6 ro;
 407
 408         if (IN6_IS_ADDR_MULTICAST(taddr6))
 409                 return;
 410
 411         /* estimate the size of message */
 412         maxlen = sizeof(*ip6) + sizeof(*nd_ns);
 413         maxlen += (sizeof(struct nd_opt_hdr) + ifp->if_addrlen + 7) & ~7;
 414         if (max_linkhdr + maxlen >= MCLBYTES) {
 415 #ifdef DIAGNOSTIC
 416                 printf("nd6_ns_output: max_linkhdr + maxlen >= MCLBYTES "
 417                     "(%d + %d > %d)\n", max_linkhdr, maxlen, MCLBYTES);
 418 #endif
 419                 return;
 420         }
 421
 422         MGETHDR(m, M_NOWAIT, MT_DATA);
 423         if (m && max_linkhdr + maxlen >= MHLEN) {
 424                 MCLGET(m, M_NOWAIT);
 425                 if ((m->m_flags & M_EXT) == 0) {
 426                         m_free(m);
 427                         m = NULL;
 428                 }
 429         }
 430         if (m == NULL)
 431                 return;
 432         m->m_pkthdr.rcvif = NULL;
 433
 434         bzero(&ro, sizeof(ro));
 435
 436         if (daddr6 == NULL || IN6_IS_ADDR_MULTICAST(daddr6)) {
 437                 m->m_flags |= M_MCAST;
 438                 im6o.im6o_multicast_ifp = ifp;
 439                 im6o.im6o_multicast_hlim = 255;
 440                 im6o.im6o_multicast_loop = 0;
 441         }
 442
 443         icmp6len = sizeof(*nd_ns);
 444         m->m_pkthdr.len = m->m_len = sizeof(*ip6) + icmp6len;
 445         m->m_data += max_linkhdr;       /* or MH_ALIGN() equivalent? */
 446
 447         /* fill neighbor solicitation packet */
 448         ip6 = mtod(m, struct ip6_hdr *);
 449         ip6->ip6_flow = 0;
 450         ip6->ip6_vfc &= ~IPV6_VERSION_MASK;
 451         ip6->ip6_vfc |= IPV6_VERSION;
 452         /* ip6->ip6_plen will be set later */
 453         ip6->ip6_nxt = IPPROTO_ICMPV6;
 454         ip6->ip6_hlim = 255;
 455         if (daddr6)
 456                 ip6->ip6_dst = *daddr6;
 457         else {
 458                 ip6->ip6_dst.s6_addr16[0] = IPV6_ADDR_INT16_MLL;
 459                 ip6->ip6_dst.s6_addr16[1] = 0;
 460                 ip6->ip6_dst.s6_addr32[1] = 0;
 461                 ip6->ip6_dst.s6_addr32[2] = IPV6_ADDR_INT32_ONE;
 462                 ip6->ip6_dst.s6_addr32[3] = taddr6->s6_addr32[3];
 463                 ip6->ip6_dst.s6_addr8[12] = 0xff;
 464                 if (in6_setscope(&ip6->ip6_dst, ifp, NULL) != 0)
 465                         goto bad;
 466         }
 467         if (!dad) {
 468                 struct ifaddr *ifa;
 469
 470                 /*
 471                  * RFC2461 7.2.2:
 472                  * "If the source address of the packet prompting the
 473                  * solicitation is the same as one of the addresses assigned
 474                  * to the outgoing interface, that address SHOULD be placed
 475                  * in the IP Source Address of the outgoing solicitation.
 476                  * Otherwise, any one of the addresses assigned to the
 477                  * interface should be used."
 478                  *
 479                  * We use the source address for the prompting packet
 480                  * (saddr6), if:
 481                  * - saddr6 is given from the caller (by giving "ln"), and
 482                  * - saddr6 belongs to the outgoing interface.
 483                  * Otherwise, we perform the source address selection as usual.
 484                  */
 485                 struct in6_addr *hsrc;
 486
 487                 hsrc = NULL;
 488                 if (ln != NULL) {
 489                         LLE_RLOCK(ln);
 490                         if (ln->la_hold != NULL) {
 491                                 struct ip6_hdr *hip6;           /* hold ip6 */
 492
 493                                 /*
 494                                  * assuming every packet in la_hold has the same IP
 495                                  * header
 496                                  */
 497                                 hip6 = mtod(ln->la_hold, struct ip6_hdr *);
 498                                 /* XXX pullup? */
 499                                 if (sizeof(*hip6) < ln->la_hold->m_len) {
 500                                         ip6->ip6_src = hip6->ip6_src;
 501                                         hsrc = &hip6->ip6_src;
 502                                 }
 503                         }
 504                         LLE_RUNLOCK(ln);
 505                 }
 506                 if (hsrc && (ifa = (struct ifaddr *)in6ifa_ifpwithaddr(ifp,
 507                     hsrc)) != NULL) {
 508                         /* ip6_src set already. */
 509                         ifa_free(ifa);
 510                 } else {
 511                         int error;
 512                         struct sockaddr_in6 dst_sa;
 513                         struct in6_addr src_in;
 514                         struct ifnet *oifp;
 515
 516                         bzero(&dst_sa, sizeof(dst_sa));
 517                         dst_sa.sin6_family = AF_INET6;
 518                         dst_sa.sin6_len = sizeof(dst_sa);
 519                         dst_sa.sin6_addr = ip6->ip6_dst;
 520
 521                         oifp = ifp;
 522                         error = in6_selectsrc(&dst_sa, NULL,
 523                             NULL, &ro, NULL, &oifp, &src_in);
 524                         if (error) {
 525                                 char ip6buf[INET6_ADDRSTRLEN];
 526                                 nd6log((LOG_DEBUG,
 527                                     "nd6_ns_output: source can't be "
 528                                     "determined: dst=%s, error=%d\n",
 529                                     ip6_sprintf(ip6buf, &dst_sa.sin6_addr),
 530                                     error));
 531                                 goto bad;
 532                         }
 533                         ip6->ip6_src = src_in;
 534                 }
 535         } else {
 536                 /*
 537                  * Source address for DAD packet must always be IPv6
 538                  * unspecified address. (0::0)
 539                  * We actually don't have to 0-clear the address (we did it
 540                  * above), but we do so here explicitly to make the intention
 541                  * clearer.
 542                  */
 543                 bzero(&ip6->ip6_src, sizeof(ip6->ip6_src));
 544         }
 545         nd_ns = (struct nd_neighbor_solicit *)(ip6 + 1);
 546         nd_ns->nd_ns_type = ND_NEIGHBOR_SOLICIT;
 547         nd_ns->nd_ns_code = 0;
 548         nd_ns->nd_ns_reserved = 0;
 549         nd_ns->nd_ns_target = *taddr6;
 550         in6_clearscope(&nd_ns->nd_ns_target); /* XXX */
 551
 552         /*
 553          * Add source link-layer address option.
 554          *
 555          *                              spec            implementation
 556          *                              ---             ---
 557          * DAD packet                   MUST NOT        do not add the option
 558          * there's no link layer address:
 559          *                              impossible      do not add the option
 560          * there's link layer address:
 561          *      Multicast NS            MUST add one    add the option
 562          *      Unicast NS              SHOULD add one  add the option
 563          */
 564         if (!dad && (mac = nd6_ifptomac(ifp))) {
 565                 int optlen = sizeof(struct nd_opt_hdr) + ifp->if_addrlen;
 566                 struct nd_opt_hdr *nd_opt = (struct nd_opt_hdr *)(nd_ns + 1);
 567                 /* 8 byte alignments... */
 568                 optlen = (optlen + 7) & ~7;
 569
 570                 m->m_pkthdr.len += optlen;
 571                 m->m_len += optlen;
 572                 icmp6len += optlen;
 573                 bzero((caddr_t)nd_opt, optlen);
 574                 nd_opt->nd_opt_type = ND_OPT_SOURCE_LINKADDR;
 575                 nd_opt->nd_opt_len = optlen >> 3;
 576                 bcopy(mac, (caddr_t)(nd_opt + 1), ifp->if_addrlen);
 577         }
 578
 579         ip6->ip6_plen = htons((u_short)icmp6len);
 580         nd_ns->nd_ns_cksum = 0;
 581         nd_ns->nd_ns_cksum =
 582             in6_cksum(m, IPPROTO_ICMPV6, sizeof(*ip6), icmp6len);
 583
 584         if (send_sendso_input_hook != NULL) {
 585                 mtag = m_tag_get(PACKET_TAG_ND_OUTGOING,
 586                         sizeof(unsigned short), M_NOWAIT);
 587                 if (mtag == NULL)
 588                         goto bad;
 589                 *(unsigned short *)(mtag + 1) = nd_ns->nd_ns_type;
 590                 m_tag_prepend(m, mtag);
 591         }
 592
 593         ip6_output(m, NULL, &ro, dad ? IPV6_UNSPECSRC : 0, &im6o, NULL, NULL);
 594         icmp6_ifstat_inc(ifp, ifs6_out_msg);
 595         icmp6_ifstat_inc(ifp, ifs6_out_neighborsolicit);
 596         ICMP6STAT_INC(icp6s_outhist[ND_NEIGHBOR_SOLICIT]);
 597
 598         /* We don't cache this route. */
 599         RO_RTFREE(&ro);
 600
 601         return;
 602
 603   bad:
 604         if (ro.ro_rt) {
 605                 RTFREE(ro.ro_rt);
 606         }
 607         m_freem(m);
 608         return;
 609 }
 610
 611 /*
 612  * Neighbor advertisement input handling.
 613  *
 614  * Based on RFC 2461
 615  * Based on RFC 2462 (duplicate address detection)
 616  *
 617  * the following items are not implemented yet:
 618  * - proxy advertisement delay rule (RFC2461 7.2.8, last paragraph, SHOULD)
 619  * - anycast advertisement delay rule (RFC2461 7.2.7, SHOULD)
 620  */
 621 void
 622 nd6_na_input(struct mbuf *m, int off, int icmp6len)
 623 {
 624         struct ifnet *ifp = m->m_pkthdr.rcvif;
 625         struct ip6_hdr *ip6 = mtod(m, struct ip6_hdr *);
 626         struct nd_neighbor_advert *nd_na;
 627         struct in6_addr daddr6 = ip6->ip6_dst;
 628         struct in6_addr taddr6;
 629         int flags;
 630         int is_router;
 631         int is_solicited;
 632         int is_override;
 633         char *lladdr = NULL;
 634         int lladdrlen = 0;
 635         int checklink = 0;
 636         struct ifaddr *ifa;
 637         struct llentry *ln = NULL;
 638         union nd_opts ndopts;
 639         struct mbuf *chain = NULL;
 640         struct m_tag *mtag;
 641         struct sockaddr_in6 sin6;
 642         char ip6bufs[INET6_ADDRSTRLEN], ip6bufd[INET6_ADDRSTRLEN];
 643
 644         if (ip6->ip6_hlim != 255) {
 645                 nd6log((LOG_ERR,
 646                     "nd6_na_input: invalid hlim (%d) from %s to %s on %s\n",
 647                     ip6->ip6_hlim, ip6_sprintf(ip6bufs, &ip6->ip6_src),
 648                     ip6_sprintf(ip6bufd, &ip6->ip6_dst), if_name(ifp)));
 649                 goto bad;
 650         }
 651
 652 #ifndef PULLDOWN_TEST
 653         IP6_EXTHDR_CHECK(m, off, icmp6len,);
 654         nd_na = (struct nd_neighbor_advert *)((caddr_t)ip6 + off);
 655 #else
 656         IP6_EXTHDR_GET(nd_na, struct nd_neighbor_advert *, m, off, icmp6len);
 657         if (nd_na == NULL) {
 658                 ICMP6STAT_INC(icp6s_tooshort);
 659                 return;
 660         }
 661 #endif
 662
 663         flags = nd_na->nd_na_flags_reserved;
 664         is_router = ((flags & ND_NA_FLAG_ROUTER) != 0);
 665         is_solicited = ((flags & ND_NA_FLAG_SOLICITED) != 0);
 666         is_override = ((flags & ND_NA_FLAG_OVERRIDE) != 0);
 667
 668         taddr6 = nd_na->nd_na_target;
 669         if (in6_setscope(&taddr6, ifp, NULL))
 670                 goto bad;       /* XXX: impossible */
 671
 672         if (IN6_IS_ADDR_MULTICAST(&taddr6)) {
 673                 nd6log((LOG_ERR,
 674                     "nd6_na_input: invalid target address %s\n",
 675                     ip6_sprintf(ip6bufs, &taddr6)));
 676                 goto bad;
 677         }
 678         if (IN6_IS_ADDR_MULTICAST(&daddr6))
 679                 if (is_solicited) {
 680                         nd6log((LOG_ERR,
 681                             "nd6_na_input: a solicited adv is multicasted\n"));
 682                         goto bad;
 683                 }
 684
 685         icmp6len -= sizeof(*nd_na);
 686         nd6_option_init(nd_na + 1, icmp6len, &ndopts);
 687         if (nd6_options(&ndopts) < 0) {
 688                 nd6log((LOG_INFO,
 689                     "nd6_na_input: invalid ND option, ignored\n"));
 690                 /* nd6_options have incremented stats */
 691                 goto freeit;
 692         }
 693
 694         if (ndopts.nd_opts_tgt_lladdr) {
 695                 lladdr = (char *)(ndopts.nd_opts_tgt_lladdr + 1);
 696                 lladdrlen = ndopts.nd_opts_tgt_lladdr->nd_opt_len << 3;
 697         }
 698
 699         /*
 700          * This effectively disables the DAD check on a non-master CARP
 701          * address.
 702          */
 703         if (ifp->if_carp)
 704                 ifa = (*carp_iamatch6_p)(ifp, &taddr6);
 705         else
 706                 ifa = (struct ifaddr *)in6ifa_ifpwithaddr(ifp, &taddr6);
 707
 708         /*
 709          * Target address matches one of my interface address.
 710          *
 711          * If my address is tentative, this means that there's somebody
 712          * already using the same address as mine.  This indicates DAD failure.
 713          * This is defined in RFC 2462.
 714          *
 715          * Otherwise, process as defined in RFC 2461.
 716          */
 717         if (ifa
 718          && (((struct in6_ifaddr *)ifa)->ia6_flags & IN6_IFF_TENTATIVE)) {
 719                 ifa_free(ifa);
 720                 nd6_dad_na_input(ifa);
 721                 goto freeit;
 722         }
 723
 724         /* Just for safety, maybe unnecessary. */
 725         if (ifa) {
 726                 ifa_free(ifa);
 727                 log(LOG_ERR,
 728                     "nd6_na_input: duplicate IP6 address %s\n",
 729                     ip6_sprintf(ip6bufs, &taddr6));
 730                 goto freeit;
 731         }
 732
 733         if (lladdr && ((ifp->if_addrlen + 2 + 7) & ~7) != lladdrlen) {
 734                 nd6log((LOG_INFO, "nd6_na_input: lladdrlen mismatch for %s "
 735                     "(if %d, NA packet %d)\n", ip6_sprintf(ip6bufs, &taddr6),
 736                     ifp->if_addrlen, lladdrlen - 2));
 737                 goto bad;
 738         }
 739
 740         /*
 741          * If no neighbor cache entry is found, NA SHOULD silently be
 742          * discarded.
 743          */
 744         IF_AFDATA_LOCK(ifp);
 745         ln = nd6_lookup(&taddr6, LLE_EXCLUSIVE, ifp);
 746         IF_AFDATA_UNLOCK(ifp);
 747         if (ln == NULL) {
 748                 goto freeit;
 749         }
 750
 751         if (ln->ln_state == ND6_LLINFO_INCOMPLETE) {
 752                 /*
 753                  * If the link-layer has address, and no lladdr option came,
 754                  * discard the packet.
 755                  */
 756                 if (ifp->if_addrlen && lladdr == NULL) {
 757                         goto freeit;
 758                 }
 759
 760                 /*
 761                  * Record link-layer address, and update the state.
 762                  */
 763                 bcopy(lladdr, &ln->ll_addr, ifp->if_addrlen);
 764                 ln->la_flags |= LLE_VALID;
 765                 EVENTHANDLER_INVOKE(lle_event, ln, LLENTRY_RESOLVED);
 766                 if (is_solicited) {
 767                         ln->ln_state = ND6_LLINFO_REACHABLE;
 768                         ln->ln_byhint = 0;
 769                         if (!ND6_LLINFO_PERMANENT(ln)) {
 770                                 nd6_llinfo_settimer_locked(ln,
 771                                     (long)ND_IFINFO(ln->lle_tbl->llt_ifp)->reachable * hz);
 772                         }
 773                 } else {
 774                         ln->ln_state = ND6_LLINFO_STALE;
 775                         nd6_llinfo_settimer_locked(ln, (long)V_nd6_gctimer * hz);
 776                 }
 777                 if ((ln->ln_router = is_router) != 0) {
 778                         /*
 779                          * This means a router's state has changed from
 780                          * non-reachable to probably reachable, and might
 781                          * affect the status of associated prefixes..
 782                          */
 783                         checklink = 1;
 784                 }
 785         } else {
 786                 int llchange;
 787
 788                 /*
 789                  * Check if the link-layer address has changed or not.
 790                  */
 791                 if (lladdr == NULL)
 792                         llchange = 0;
 793                 else {
 794                         if (ln->la_flags & LLE_VALID) {
 795                                 if (bcmp(lladdr, &ln->ll_addr, ifp->if_addrlen))
 796                                         llchange = 1;
 797                                 else
 798                                         llchange = 0;
 799                         } else
 800                                 llchange = 1;
 801                 }
 802
 803                 /*
 804                  * This is VERY complex.  Look at it with care.
 805                  *
 806                  * override solicit lladdr llchange     action
 807                  *                                      (L: record lladdr)
 808                  *
 809                  *      0       0       n       --      (2c)
 810                  *      0       0       y       n       (2b) L
 811                  *      0       0       y       y       (1)    REACHABLE->STALE
 812                  *      0       1       n       --      (2c)   *->REACHABLE
 813                  *      0       1       y       n       (2b) L *->REACHABLE
 814                  *      0       1       y       y       (1)    REACHABLE->STALE
 815                  *      1       0       n       --      (2a)
 816                  *      1       0       y       n       (2a) L
 817                  *      1       0       y       y       (2a) L *->STALE
 818                  *      1       1       n       --      (2a)   *->REACHABLE
 819                  *      1       1       y       n       (2a) L *->REACHABLE
 820                  *      1       1       y       y       (2a) L *->REACHABLE
 821                  */
 822                 if (!is_override && (lladdr != NULL && llchange)) {  /* (1) */
 823                         /*
 824                          * If state is REACHABLE, make it STALE.
 825                          * no other updates should be done.
 826                          */
 827                         if (ln->ln_state == ND6_LLINFO_REACHABLE) {
 828                                 ln->ln_state = ND6_LLINFO_STALE;
 829                                 nd6_llinfo_settimer_locked(ln, (long)V_nd6_gctimer * hz);
 830                         }
 831                         goto freeit;
 832                 } else if (is_override                             /* (2a) */
 833                         || (!is_override && (lladdr != NULL && !llchange)) /* (2b) */
 834                         || lladdr == NULL) {                       /* (2c) */
 835                         /*
 836                          * Update link-local address, if any.
 837                          */
 838                         if (lladdr != NULL) {
 839                                 bcopy(lladdr, &ln->ll_addr, ifp->if_addrlen);
 840                                 ln->la_flags |= LLE_VALID;
 841                                 EVENTHANDLER_INVOKE(lle_event, ln,
 842                                     LLENTRY_RESOLVED);
 843                         }
 844
 845                         /*
 846                          * If solicited, make the state REACHABLE.
 847                          * If not solicited and the link-layer address was
 848                          * changed, make it STALE.
 849                          */
 850                         if (is_solicited) {
 851                                 ln->ln_state = ND6_LLINFO_REACHABLE;
 852                                 ln->ln_byhint = 0;
 853                                 if (!ND6_LLINFO_PERMANENT(ln)) {
 854                                         nd6_llinfo_settimer_locked(ln,
 855                                             (long)ND_IFINFO(ifp)->reachable * hz);
 856                                 }
 857                         } else {
 858                                 if (lladdr != NULL && llchange) {
 859                                         ln->ln_state = ND6_LLINFO_STALE;
 860                                         nd6_llinfo_settimer_locked(ln,
 861                                             (long)V_nd6_gctimer * hz);
 862                                 }
 863                         }
 864                 }
 865
 866                 if (ln->ln_router && !is_router) {
 867                         /*
 868                          * The peer dropped the router flag.
 869                          * Remove the sender from the Default Router List and
 870                          * update the Destination Cache entries.
 871                          */
 872                         struct nd_defrouter *dr;
 873                         struct in6_addr *in6;
 874
 875                         in6 = &L3_ADDR_SIN6(ln)->sin6_addr;
 876
 877                         /*
 878                          * Lock to protect the default router list.
 879                          * XXX: this might be unnecessary, since this function
 880                          * is only called under the network software interrupt
 881                          * context.  However, we keep it just for safety.
 882                          */
 883                         dr = defrouter_lookup(in6, ln->lle_tbl->llt_ifp);
 884                         if (dr)
 885                                 defrtrlist_del(dr);
 886                         else if (ND_IFINFO(ln->lle_tbl->llt_ifp)->flags &
 887                             ND6_IFF_ACCEPT_RTADV) {
 888                                 /*
 889                                  * Even if the neighbor is not in the default
 890                                  * router list, the neighbor may be used
 891                                  * as a next hop for some destinations
 892                                  * (e.g. redirect case). So we must
 893                                  * call rt6_flush explicitly.
 894                                  */
 895                                 rt6_flush(&ip6->ip6_src, ifp);
 896                         }
 897                 }
 898                 ln->ln_router = is_router;
 899         }
 900         /* XXX - QL
 901          *  Does this matter?
 902          *  rt->rt_flags &= ~RTF_REJECT;
 903          */
 904         ln->la_asked = 0;
 905         if (ln->la_hold) {
 906                 struct mbuf *m_hold, *m_hold_next;
 907
 908                 /*
 909                  * reset the la_hold in advance, to explicitly
 910                  * prevent a la_hold lookup in nd6_output()
 911                  * (wouldn't happen, though...)
 912                  */
 913                 for (m_hold = ln->la_hold, ln->la_hold = NULL;
 914                     m_hold; m_hold = m_hold_next) {
 915                         m_hold_next = m_hold->m_nextpkt;
 916                         m_hold->m_nextpkt = NULL;
 917                         /*
 918                          * we assume ifp is not a loopback here, so just set
 919                          * the 2nd argument as the 1st one.
 920                          */
 921
 922                         if (send_sendso_input_hook != NULL) {
 923                                 mtag = m_tag_get(PACKET_TAG_ND_OUTGOING,
 924                                     sizeof(unsigned short), M_NOWAIT);
 925                                 if (mtag == NULL)
 926                                         goto bad;
 927                                 m_tag_prepend(m, mtag);
 928                         }
 929
 930                         nd6_output_lle(ifp, ifp, m_hold, L3_ADDR_SIN6(ln), NULL, ln, &chain);
 931                 }
 932         }
 933  freeit:
 934         if (ln != NULL) {
 935                 if (chain)
 936                         memcpy(&sin6, L3_ADDR_SIN6(ln), sizeof(sin6));
 937                 LLE_WUNLOCK(ln);
 938
 939                 if (chain)
 940                         nd6_output_flush(ifp, ifp, chain, &sin6, NULL);
 941         }
 942         if (checklink)
 943                 pfxlist_onlink_check();
 944
 945         m_freem(m);
 946         return;
 947
 948  bad:
 949         if (ln != NULL)
 950                 LLE_WUNLOCK(ln);
 951
 952         ICMP6STAT_INC(icp6s_badna);
 953         m_freem(m);
 954 }
 955
 956 /*
 957  * Neighbor advertisement output handling.
 958  *
 959  * Based on RFC 2461
 960  *
 961  * the following items are not implemented yet:
 962  * - proxy advertisement delay rule (RFC2461 7.2.8, last paragraph, SHOULD)
 963  * - anycast advertisement delay rule (RFC2461 7.2.7, SHOULD)
 964  *
 965  * tlladdr - 1 if include target link-layer address
 966  * sdl0 - sockaddr_dl (= proxy NA) or NULL
 967  */
 968 static void
 969 nd6_na_output_fib(struct ifnet *ifp, const struct in6_addr *daddr6_0,
 970     const struct in6_addr *taddr6, u_long flags, int tlladdr,
 971     struct sockaddr *sdl0, u_int fibnum)
 972 {
 973         struct mbuf *m;
 974         struct m_tag *mtag;
 975         struct ifnet *oifp;
 976         struct ip6_hdr *ip6;
 977         struct nd_neighbor_advert *nd_na;
 978         struct ip6_moptions im6o;
 979         struct in6_addr src, daddr6;
 980         struct sockaddr_in6 dst_sa;
 981         int icmp6len, maxlen, error;
 982         caddr_t mac = NULL;
 983         struct route_in6 ro;
 984
 985         bzero(&ro, sizeof(ro));
 986
 987         daddr6 = *daddr6_0;     /* make a local copy for modification */
 988
 989         /* estimate the size of message */
 990         maxlen = sizeof(*ip6) + sizeof(*nd_na);
 991         maxlen += (sizeof(struct nd_opt_hdr) + ifp->if_addrlen + 7) & ~7;
 992         if (max_linkhdr + maxlen >= MCLBYTES) {
 993 #ifdef DIAGNOSTIC
 994                 printf("nd6_na_output: max_linkhdr + maxlen >= MCLBYTES "
 995                     "(%d + %d > %d)\n", max_linkhdr, maxlen, MCLBYTES);
 996 #endif
 997                 return;
 998         }
 999
1000         MGETHDR(m, M_NOWAIT, MT_DATA);
1001         if (m && max_linkhdr + maxlen >= MHLEN) {
1002                 MCLGET(m, M_NOWAIT);
1003                 if ((m->m_flags & M_EXT) == 0) {
1004                         m_free(m);
1005                         m = NULL;
1006                 }
1007         }
1008         if (m == NULL)
1009                 return;
1010         m->m_pkthdr.rcvif = NULL;
1011         M_SETFIB(m, fibnum);
1012
1013         if (IN6_IS_ADDR_MULTICAST(&daddr6)) {
1014                 m->m_flags |= M_MCAST;
1015                 im6o.im6o_multicast_ifp = ifp;
1016                 im6o.im6o_multicast_hlim = 255;
1017                 im6o.im6o_multicast_loop = 0;
1018         }
1019
1020         icmp6len = sizeof(*nd_na);
1021         m->m_pkthdr.len = m->m_len = sizeof(struct ip6_hdr) + icmp6len;
1022         m->m_data += max_linkhdr;       /* or MH_ALIGN() equivalent? */
1023
1024         /* fill neighbor advertisement packet */
1025         ip6 = mtod(m, struct ip6_hdr *);
1026         ip6->ip6_flow = 0;
1027         ip6->ip6_vfc &= ~IPV6_VERSION_MASK;
1028         ip6->ip6_vfc |= IPV6_VERSION;
1029         ip6->ip6_nxt = IPPROTO_ICMPV6;
1030         ip6->ip6_hlim = 255;
1031         if (IN6_IS_ADDR_UNSPECIFIED(&daddr6)) {
1032                 /* reply to DAD */
1033                 daddr6.s6_addr16[0] = IPV6_ADDR_INT16_MLL;
1034                 daddr6.s6_addr16[1] = 0;
1035                 daddr6.s6_addr32[1] = 0;
1036                 daddr6.s6_addr32[2] = 0;
1037                 daddr6.s6_addr32[3] = IPV6_ADDR_INT32_ONE;
1038                 if (in6_setscope(&daddr6, ifp, NULL))
1039                         goto bad;
1040
1041                 flags &= ~ND_NA_FLAG_SOLICITED;
1042         }
1043         ip6->ip6_dst = daddr6;
1044         bzero(&dst_sa, sizeof(struct sockaddr_in6));
1045         dst_sa.sin6_family = AF_INET6;
1046         dst_sa.sin6_len = sizeof(struct sockaddr_in6);
1047         dst_sa.sin6_addr = daddr6;
1048
1049         /*
1050          * Select a source whose scope is the same as that of the dest.
1051          */
1052         bcopy(&dst_sa, &ro.ro_dst, sizeof(dst_sa));
1053         oifp = ifp;
1054         error = in6_selectsrc(&dst_sa, NULL, NULL, &ro, NULL, &oifp, &src);
1055         if (error) {
1056                 char ip6buf[INET6_ADDRSTRLEN];
1057                 nd6log((LOG_DEBUG, "nd6_na_output: source can't be "
1058                     "determined: dst=%s, error=%d\n",
1059                     ip6_sprintf(ip6buf, &dst_sa.sin6_addr), error));
1060                 goto bad;
1061         }
1062         ip6->ip6_src = src;
1063         nd_na = (struct nd_neighbor_advert *)(ip6 + 1);
1064         nd_na->nd_na_type = ND_NEIGHBOR_ADVERT;
1065         nd_na->nd_na_code = 0;
1066         nd_na->nd_na_target = *taddr6;
1067         in6_clearscope(&nd_na->nd_na_target); /* XXX */
1068
1069         /*
1070          * "tlladdr" indicates NS's condition for adding tlladdr or not.
1071          * see nd6_ns_input() for details.
1072          * Basically, if NS packet is sent to unicast/anycast addr,
1073          * target lladdr option SHOULD NOT be included.
1074          */
1075         if (tlladdr) {
1076                 /*
1077                  * sdl0 != NULL indicates proxy NA.  If we do proxy, use
1078                  * lladdr in sdl0.  If we are not proxying (sending NA for
1079                  * my address) use lladdr configured for the interface.
1080                  */
1081                 if (sdl0 == NULL) {
1082                         if (ifp->if_carp)
1083                                 mac = (*carp_macmatch6_p)(ifp, m, taddr6);
1084                         if (mac == NULL)
1085                                 mac = nd6_ifptomac(ifp);
1086                 } else if (sdl0->sa_family == AF_LINK) {
1087                         struct sockaddr_dl *sdl;
1088                         sdl = (struct sockaddr_dl *)sdl0;
1089                         if (sdl->sdl_alen == ifp->if_addrlen)
1090                                 mac = LLADDR(sdl);
1091                 }
1092         }
1093         if (tlladdr && mac) {
1094                 int optlen = sizeof(struct nd_opt_hdr) + ifp->if_addrlen;
1095                 struct nd_opt_hdr *nd_opt = (struct nd_opt_hdr *)(nd_na + 1);
1096
1097                 /* roundup to 8 bytes alignment! */
1098                 optlen = (optlen + 7) & ~7;
1099
1100                 m->m_pkthdr.len += optlen;
1101                 m->m_len += optlen;
1102                 icmp6len += optlen;
1103                 bzero((caddr_t)nd_opt, optlen);
1104                 nd_opt->nd_opt_type = ND_OPT_TARGET_LINKADDR;
1105                 nd_opt->nd_opt_len = optlen >> 3;
1106                 bcopy(mac, (caddr_t)(nd_opt + 1), ifp->if_addrlen);
1107         } else
1108                 flags &= ~ND_NA_FLAG_OVERRIDE;
1109
1110         ip6->ip6_plen = htons((u_short)icmp6len);
1111         nd_na->nd_na_flags_reserved = flags;
1112         nd_na->nd_na_cksum = 0;
1113         nd_na->nd_na_cksum =
1114             in6_cksum(m, IPPROTO_ICMPV6, sizeof(struct ip6_hdr), icmp6len);
1115
1116         if (send_sendso_input_hook != NULL) {
1117                 mtag = m_tag_get(PACKET_TAG_ND_OUTGOING,
1118                     sizeof(unsigned short), M_NOWAIT);
1119                 if (mtag == NULL)
1120                         goto bad;
1121                 *(unsigned short *)(mtag + 1) = nd_na->nd_na_type;
1122                 m_tag_prepend(m, mtag);
1123         }
1124
1125         ip6_output(m, NULL, &ro, 0, &im6o, NULL, NULL);
1126         icmp6_ifstat_inc(ifp, ifs6_out_msg);
1127         icmp6_ifstat_inc(ifp, ifs6_out_neighboradvert);
1128         ICMP6STAT_INC(icp6s_outhist[ND_NEIGHBOR_ADVERT]);
1129
1130         /* We don't cache this route. */
1131         RO_RTFREE(&ro);
1132
1133         return;
1134
1135   bad:
1136         if (ro.ro_rt) {
1137                 RTFREE(ro.ro_rt);
1138         }
1139         m_freem(m);
1140         return;
1141 }
1142
1143 #ifndef BURN_BRIDGES
1144 void
1145 nd6_na_output(struct ifnet *ifp, const struct in6_addr *daddr6_0,
1146     const struct in6_addr *taddr6, u_long flags, int tlladdr,
1147     struct sockaddr *sdl0)
1148 {
1149
1150         nd6_na_output_fib(ifp, daddr6_0, taddr6, flags, tlladdr, sdl0,
1151             RT_DEFAULT_FIB);
1152 }
1153 #endif
1154
1155 caddr_t
1156 nd6_ifptomac(struct ifnet *ifp)
1157 {
1158         switch (ifp->if_type) {
1159         case IFT_ARCNET:
1160         case IFT_ETHER:
1161         case IFT_FDDI:
1162         case IFT_IEEE1394:
1163 #ifdef IFT_L2VLAN
1164         case IFT_L2VLAN:
1165 #endif
1166 #ifdef IFT_IEEE80211
1167         case IFT_IEEE80211:
1168 #endif
1169         case IFT_INFINIBAND:
1170         case IFT_BRIDGE:
1171         case IFT_ISO88025:
1172                 return IF_LLADDR(ifp);
1173         default:
1174                 return NULL;
1175         }
1176 }
1177
1178 struct dadq {
1179         TAILQ_ENTRY(dadq) dad_list;
1180         struct ifaddr *dad_ifa;
1181         int dad_count;          /* max NS to send */
1182         int dad_ns_tcount;      /* # of trials to send NS */
1183         int dad_ns_ocount;      /* NS sent so far */
1184         int dad_ns_icount;
1185         int dad_na_icount;
1186         struct callout dad_timer_ch;
1187         struct vnet *dad_vnet;
1188 };
1189
1190 static VNET_DEFINE(TAILQ_HEAD(, dadq), dadq);
1191 VNET_DEFINE(int, dad_init) = 0;
1192 #define V_dadq                          VNET(dadq)
1193 #define V_dad_init                      VNET(dad_init)
1194
1195 static struct dadq *
1196 nd6_dad_find(struct ifaddr *ifa)
1197 {
1198         struct dadq *dp;
1199
1200         TAILQ_FOREACH(dp, &V_dadq, dad_list)
1201                 if (dp->dad_ifa == ifa)
1202                         return (dp);
1203
1204         return (NULL);
1205 }
1206
1207 static void
1208 nd6_dad_starttimer(struct dadq *dp, int ticks)
1209 {
1210
1211         callout_reset(&dp->dad_timer_ch, ticks,
1212             (void (*)(void *))nd6_dad_timer, (void *)dp);
1213 }
1214
1215 static void
1216 nd6_dad_stoptimer(struct dadq *dp)
1217 {
1218
1219         callout_stop(&dp->dad_timer_ch);
1220 }
1221
1222 /*
1223  * Start Duplicate Address Detection (DAD) for specified interface address.
1224  */
1225 void
1226 nd6_dad_start(struct ifaddr *ifa, int delay)
1227 {
1228         struct in6_ifaddr *ia = (struct in6_ifaddr *)ifa;
1229         struct dadq *dp;
1230         char ip6buf[INET6_ADDRSTRLEN];
1231
1232         if (!V_dad_init) {
1233                 TAILQ_INIT(&V_dadq);
1234                 V_dad_init++;
1235         }
1236
1237         /*
1238          * If we don't need DAD, don't do it.
1239          * There are several cases:
1240          * - DAD is disabled (ip6_dad_count == 0)
1241          * - the interface address is anycast
1242          */
1243         if (!(ia->ia6_flags & IN6_IFF_TENTATIVE)) {
1244                 log(LOG_DEBUG,
1245                         "nd6_dad_start: called with non-tentative address "
1246                         "%s(%s)\n",
1247                         ip6_sprintf(ip6buf, &ia->ia_addr.sin6_addr),
1248                         ifa->ifa_ifp ? if_name(ifa->ifa_ifp) : "???");
1249                 return;
1250         }
1251         if (ia->ia6_flags & IN6_IFF_ANYCAST) {
1252                 ia->ia6_flags &= ~IN6_IFF_TENTATIVE;
1253                 return;
1254         }
1255         if (!V_ip6_dad_count) {
1256                 ia->ia6_flags &= ~IN6_IFF_TENTATIVE;
1257                 return;
1258         }
1259         if (ifa->ifa_ifp == NULL)
1260                 panic("nd6_dad_start: ifa->ifa_ifp == NULL");
1261         if (!(ifa->ifa_ifp->if_flags & IFF_UP)) {
1262                 return;
1263         }
1264         if (ND_IFINFO(ifa->ifa_ifp)->flags & ND6_IFF_IFDISABLED)
1265                 return;
1266         if (nd6_dad_find(ifa) != NULL) {
1267                 /* DAD already in progress */
1268                 return;
1269         }
1270
1271         dp = malloc(sizeof(*dp), M_IP6NDP, M_NOWAIT);
1272         if (dp == NULL) {
1273                 log(LOG_ERR, "nd6_dad_start: memory allocation failed for "
1274                         "%s(%s)\n",
1275                         ip6_sprintf(ip6buf, &ia->ia_addr.sin6_addr),
1276                         ifa->ifa_ifp ? if_name(ifa->ifa_ifp) : "???");
1277                 return;
1278         }
1279         bzero(dp, sizeof(*dp));
1280         callout_init(&dp->dad_timer_ch, 0);
1281 #ifdef VIMAGE
1282         dp->dad_vnet = curvnet;
1283 #endif
1284         TAILQ_INSERT_TAIL(&V_dadq, (struct dadq *)dp, dad_list);
1285
1286         nd6log((LOG_DEBUG, "%s: starting DAD for %s\n", if_name(ifa->ifa_ifp),
1287             ip6_sprintf(ip6buf, &ia->ia_addr.sin6_addr)));
1288
1289         /*
1290          * Send NS packet for DAD, ip6_dad_count times.
1291          * Note that we must delay the first transmission, if this is the
1292          * first packet to be sent from the interface after interface
1293          * (re)initialization.
1294          */
1295         dp->dad_ifa = ifa;
1296         ifa_ref(ifa);   /* just for safety */
1297         dp->dad_count = V_ip6_dad_count;
1298         dp->dad_ns_icount = dp->dad_na_icount = 0;
1299         dp->dad_ns_ocount = dp->dad_ns_tcount = 0;
1300         if (delay == 0) {
1301                 nd6_dad_ns_output(dp, ifa);
1302                 nd6_dad_starttimer(dp,
1303                     (long)ND_IFINFO(ifa->ifa_ifp)->retrans * hz / 1000);
1304         } else {
1305                 nd6_dad_starttimer(dp, delay);
1306         }
1307 }
1308
1309 /*
1310  * terminate DAD unconditionally.  used for address removals.
1311  */
1312 void
1313 nd6_dad_stop(struct ifaddr *ifa)
1314 {
1315         struct dadq *dp;
1316
1317         if (!V_dad_init)
1318                 return;
1319         dp = nd6_dad_find(ifa);
1320         if (!dp) {
1321                 /* DAD wasn't started yet */
1322                 return;
1323         }
1324
1325         nd6_dad_stoptimer(dp);
1326
1327         TAILQ_REMOVE(&V_dadq, (struct dadq *)dp, dad_list);
1328         free(dp, M_IP6NDP);
1329         dp = NULL;
1330         ifa_free(ifa);
1331 }
1332
1333 static void
1334 nd6_dad_timer(struct dadq *dp)
1335 {
1336         CURVNET_SET(dp->dad_vnet);
1337         struct ifaddr *ifa = dp->dad_ifa;
1338         struct in6_ifaddr *ia = (struct in6_ifaddr *)ifa;
1339         char ip6buf[INET6_ADDRSTRLEN];
1340
1341         /* Sanity check */
1342         if (ia == NULL) {
1343                 log(LOG_ERR, "nd6_dad_timer: called with null parameter\n");
1344                 goto done;
1345         }
1346         if (ia->ia6_flags & IN6_IFF_DUPLICATED) {
1347                 log(LOG_ERR, "nd6_dad_timer: called with duplicated address "
1348                         "%s(%s)\n",
1349                         ip6_sprintf(ip6buf, &ia->ia_addr.sin6_addr),
1350                         ifa->ifa_ifp ? if_name(ifa->ifa_ifp) : "???");
1351                 goto done;
1352         }
1353         if ((ia->ia6_flags & IN6_IFF_TENTATIVE) == 0) {
1354                 log(LOG_ERR, "nd6_dad_timer: called with non-tentative address "
1355                         "%s(%s)\n",
1356                         ip6_sprintf(ip6buf, &ia->ia_addr.sin6_addr),
1357                         ifa->ifa_ifp ? if_name(ifa->ifa_ifp) : "???");
1358                 goto done;
1359         }
1360
1361         /* timeouted with IFF_{RUNNING,UP} check */
1362         if (dp->dad_ns_tcount > V_dad_maxtry) {
1363                 nd6log((LOG_INFO, "%s: could not run DAD, driver problem?\n",
1364                     if_name(ifa->ifa_ifp)));
1365
1366                 TAILQ_REMOVE(&V_dadq, (struct dadq *)dp, dad_list);
1367                 free(dp, M_IP6NDP);
1368                 dp = NULL;
1369                 ifa_free(ifa);
1370                 goto done;
1371         }
1372
1373         /* Need more checks? */
1374         if (dp->dad_ns_ocount < dp->dad_count) {
1375                 /*
1376                  * We have more NS to go.  Send NS packet for DAD.
1377                  */
1378                 nd6_dad_ns_output(dp, ifa);
1379                 nd6_dad_starttimer(dp,
1380                     (long)ND_IFINFO(ifa->ifa_ifp)->retrans * hz / 1000);
1381         } else {
1382                 /*
1383                  * We have transmitted sufficient number of DAD packets.
1384                  * See what we've got.
1385                  */
1386                 int duplicate;
1387
1388                 duplicate = 0;
1389
1390                 if (dp->dad_na_icount) {
1391                         /*
1392                          * the check is in nd6_dad_na_input(),
1393                          * but just in case
1394                          */
1395                         duplicate++;
1396                 }
1397
1398                 if (dp->dad_ns_icount) {
1399                         /* We've seen NS, means DAD has failed. */
1400                         duplicate++;
1401                 }
1402
1403                 if (duplicate) {
1404                         /* (*dp) will be freed in nd6_dad_duplicated() */
1405                         dp = NULL;
1406                         nd6_dad_duplicated(ifa);
1407                 } else {
1408                         /*
1409                          * We are done with DAD.  No NA came, no NS came.
1410                          * No duplicate address found.
1411                          */
1412                         ia->ia6_flags &= ~IN6_IFF_TENTATIVE;
1413
1414                         nd6log((LOG_DEBUG,
1415                             "%s: DAD complete for %s - no duplicates found\n",
1416                             if_name(ifa->ifa_ifp),
1417                             ip6_sprintf(ip6buf, &ia->ia_addr.sin6_addr)));
1418
1419                         TAILQ_REMOVE(&V_dadq, (struct dadq *)dp, dad_list);
1420                         free(dp, M_IP6NDP);
1421                         dp = NULL;
1422                         ifa_free(ifa);
1423                 }
1424         }
1425
1426 done:
1427         CURVNET_RESTORE();
1428 }
1429
1430 void
1431 nd6_dad_duplicated(struct ifaddr *ifa)
1432 {
1433         struct in6_ifaddr *ia = (struct in6_ifaddr *)ifa;
1434         struct ifnet *ifp;
1435         struct dadq *dp;
1436         char ip6buf[INET6_ADDRSTRLEN];
1437
1438         dp = nd6_dad_find(ifa);
1439         if (dp == NULL) {
1440                 log(LOG_ERR, "nd6_dad_duplicated: DAD structure not found\n");
1441                 return;
1442         }
1443
1444         log(LOG_ERR, "%s: DAD detected duplicate IPv6 address %s: "
1445             "NS in/out=%d/%d, NA in=%d\n",
1446             if_name(ifa->ifa_ifp), ip6_sprintf(ip6buf, &ia->ia_addr.sin6_addr),
1447             dp->dad_ns_icount, dp->dad_ns_ocount, dp->dad_na_icount);
1448
1449         ia->ia6_flags &= ~IN6_IFF_TENTATIVE;
1450         ia->ia6_flags |= IN6_IFF_DUPLICATED;
1451
1452         /* We are done with DAD, with duplicate address found. (failure) */
1453         nd6_dad_stoptimer(dp);
1454
1455         ifp = ifa->ifa_ifp;
1456         log(LOG_ERR, "%s: DAD complete for %s - duplicate found\n",
1457             if_name(ifp), ip6_sprintf(ip6buf, &ia->ia_addr.sin6_addr));
1458         log(LOG_ERR, "%s: manual intervention required\n",
1459             if_name(ifp));
1460
1461         /*
1462          * If the address is a link-local address formed from an interface
1463          * identifier based on the hardware address which is supposed to be
1464          * uniquely assigned (e.g., EUI-64 for an Ethernet interface), IP
1465          * operation on the interface SHOULD be disabled.
1466          * [RFC 4862, Section 5.4.5]
1467          */
1468         if (IN6_IS_ADDR_LINKLOCAL(&ia->ia_addr.sin6_addr)) {
1469                 struct in6_addr in6;
1470
1471                 /*
1472                  * To avoid over-reaction, we only apply this logic when we are
1473                  * very sure that hardware addresses are supposed to be unique.
1474                  */
1475                 switch (ifp->if_type) {
1476                 case IFT_ETHER:
1477                 case IFT_FDDI:
1478                 case IFT_ATM:
1479                 case IFT_IEEE1394:
1480 #ifdef IFT_IEEE80211
1481                 case IFT_IEEE80211:
1482 #endif
1483                 case IFT_INFINIBAND:
1484                         in6 = ia->ia_addr.sin6_addr;
1485                         if (in6_get_hw_ifid(ifp, &in6) == 0 &&
1486                             IN6_ARE_ADDR_EQUAL(&ia->ia_addr.sin6_addr, &in6)) {
1487                                 ND_IFINFO(ifp)->flags |= ND6_IFF_IFDISABLED;
1488                                 log(LOG_ERR, "%s: possible hardware address "
1489                                     "duplication detected, disable IPv6\n",
1490                                     if_name(ifp));
1491                         }
1492                         break;
1493                 }
1494         }
1495
1496         TAILQ_REMOVE(&V_dadq, (struct dadq *)dp, dad_list);
1497         free(dp, M_IP6NDP);
1498         dp = NULL;
1499         ifa_free(ifa);
1500 }
1501
1502 static void
1503 nd6_dad_ns_output(struct dadq *dp, struct ifaddr *ifa)
1504 {
1505         struct in6_ifaddr *ia = (struct in6_ifaddr *)ifa;
1506         struct ifnet *ifp = ifa->ifa_ifp;
1507
1508         dp->dad_ns_tcount++;
1509         if ((ifp->if_flags & IFF_UP) == 0) {
1510                 return;
1511         }
1512         if ((ifp->if_drv_flags & IFF_DRV_RUNNING) == 0) {
1513                 return;
1514         }
1515
1516         dp->dad_ns_ocount++;
1517         nd6_ns_output(ifp, NULL, &ia->ia_addr.sin6_addr, NULL, 1);
1518 }
1519
1520 static void
1521 nd6_dad_ns_input(struct ifaddr *ifa)
1522 {
1523         struct in6_ifaddr *ia;
1524         struct ifnet *ifp;
1525         const struct in6_addr *taddr6;
1526         struct dadq *dp;
1527         int duplicate;
1528
1529         if (ifa == NULL)
1530                 panic("ifa == NULL in nd6_dad_ns_input");
1531
1532         ia = (struct in6_ifaddr *)ifa;
1533         ifp = ifa->ifa_ifp;
1534         taddr6 = &ia->ia_addr.sin6_addr;
1535         duplicate = 0;
1536         dp = nd6_dad_find(ifa);
1537
1538         /* Quickhack - completely ignore DAD NS packets */
1539         if (V_dad_ignore_ns) {
1540                 char ip6buf[INET6_ADDRSTRLEN];
1541                 nd6log((LOG_INFO,
1542                     "nd6_dad_ns_input: ignoring DAD NS packet for "
1543                     "address %s(%s)\n", ip6_sprintf(ip6buf, taddr6),
1544                     if_name(ifa->ifa_ifp)));
1545                 return;
1546         }
1547
1548         /*
1549          * if I'm yet to start DAD, someone else started using this address
1550          * first.  I have a duplicate and you win.
1551          */
1552         if (dp == NULL || dp->dad_ns_ocount == 0)
1553                 duplicate++;
1554
1555         /* XXX more checks for loopback situation - see nd6_dad_timer too */
1556
1557         if (duplicate) {
1558                 dp = NULL;      /* will be freed in nd6_dad_duplicated() */
1559                 nd6_dad_duplicated(ifa);
1560         } else {
1561                 /*
1562                  * not sure if I got a duplicate.
1563                  * increment ns count and see what happens.
1564                  */
1565                 if (dp)
1566                         dp->dad_ns_icount++;
1567         }
1568 }
1569
1570 static void
1571 nd6_dad_na_input(struct ifaddr *ifa)
1572 {
1573         struct dadq *dp;
1574
1575         if (ifa == NULL)
1576                 panic("ifa == NULL in nd6_dad_na_input");
1577
1578         dp = nd6_dad_find(ifa);
1579         if (dp)
1580                 dp->dad_na_icount++;
1581
1582         /* remove the address. */
1583         nd6_dad_duplicated(ifa);
1584 }