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