]> CyberLeo.Net >> Repos - FreeBSD/FreeBSD.git/blob - sys/netinet/in.c
Upgrade Unbound to 1.7.1.
[FreeBSD/FreeBSD.git] / sys / netinet / in.c
1 /*-
2  * SPDX-License-Identifier: BSD-3-Clause
3  *
4  * Copyright (c) 1982, 1986, 1991, 1993
5  *      The Regents of the University of California.  All rights reserved.
6  * Copyright (C) 2001 WIDE Project.  All rights reserved.
7  *
8  * Redistribution and use in source and binary forms, with or without
9  * modification, are permitted provided that the following conditions
10  * are met:
11  * 1. Redistributions of source code must retain the above copyright
12  *    notice, this list of conditions and the following disclaimer.
13  * 2. Redistributions in binary form must reproduce the above copyright
14  *    notice, this list of conditions and the following disclaimer in the
15  *    documentation and/or other materials provided with the distribution.
16  * 3. Neither the name of the University nor the names of its contributors
17  *    may be used to endorse or promote products derived from this software
18  *    without specific prior written permission.
19  *
20  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
21  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
22  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
23  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
24  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
25  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
26  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
27  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
28  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
29  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
30  * SUCH DAMAGE.
31  *
32  *      @(#)in.c        8.4 (Berkeley) 1/9/95
33  */
34
35 #include <sys/cdefs.h>
36 __FBSDID("$FreeBSD$");
37
38 #include "opt_mpath.h"
39
40 #include <sys/param.h>
41 #include <sys/eventhandler.h>
42 #include <sys/systm.h>
43 #include <sys/sockio.h>
44 #include <sys/malloc.h>
45 #include <sys/priv.h>
46 #include <sys/socket.h>
47 #include <sys/jail.h>
48 #include <sys/kernel.h>
49 #include <sys/lock.h>
50 #include <sys/proc.h>
51 #include <sys/rmlock.h>
52 #include <sys/sysctl.h>
53 #include <sys/syslog.h>
54 #include <sys/sx.h>
55
56 #include <net/if.h>
57 #include <net/if_var.h>
58 #include <net/if_arp.h>
59 #include <net/if_dl.h>
60 #include <net/if_llatbl.h>
61 #include <net/if_types.h>
62 #include <net/route.h>
63 #include <net/vnet.h>
64
65 #include <netinet/if_ether.h>
66 #include <netinet/in.h>
67 #include <netinet/in_var.h>
68 #include <netinet/in_pcb.h>
69 #include <netinet/ip_var.h>
70 #include <netinet/ip_carp.h>
71 #include <netinet/igmp_var.h>
72 #include <netinet/udp.h>
73 #include <netinet/udp_var.h>
74
75 static int in_aifaddr_ioctl(u_long, caddr_t, struct ifnet *, struct thread *);
76 static int in_difaddr_ioctl(u_long, caddr_t, struct ifnet *, struct thread *);
77
78 static void     in_socktrim(struct sockaddr_in *);
79 static void     in_purgemaddrs(struct ifnet *);
80
81 static VNET_DEFINE(int, nosameprefix);
82 #define V_nosameprefix                  VNET(nosameprefix)
83 SYSCTL_INT(_net_inet_ip, OID_AUTO, no_same_prefix, CTLFLAG_VNET | CTLFLAG_RW,
84         &VNET_NAME(nosameprefix), 0,
85         "Refuse to create same prefixes on different interfaces");
86
87 VNET_DECLARE(struct inpcbinfo, ripcbinfo);
88 #define V_ripcbinfo                     VNET(ripcbinfo)
89
90 static struct sx in_control_sx;
91 SX_SYSINIT(in_control_sx, &in_control_sx, "in_control");
92
93 /*
94  * Return 1 if an internet address is for a ``local'' host
95  * (one to which we have a connection).
96  */
97 int
98 in_localaddr(struct in_addr in)
99 {
100         struct rm_priotracker in_ifa_tracker;
101         u_long i = ntohl(in.s_addr);
102         struct in_ifaddr *ia;
103
104         IN_IFADDR_RLOCK(&in_ifa_tracker);
105         TAILQ_FOREACH(ia, &V_in_ifaddrhead, ia_link) {
106                 if ((i & ia->ia_subnetmask) == ia->ia_subnet) {
107                         IN_IFADDR_RUNLOCK(&in_ifa_tracker);
108                         return (1);
109                 }
110         }
111         IN_IFADDR_RUNLOCK(&in_ifa_tracker);
112         return (0);
113 }
114
115 /*
116  * Return 1 if an internet address is for the local host and configured
117  * on one of its interfaces.
118  */
119 int
120 in_localip(struct in_addr in)
121 {
122         struct rm_priotracker in_ifa_tracker;
123         struct in_ifaddr *ia;
124
125         IN_IFADDR_RLOCK(&in_ifa_tracker);
126         LIST_FOREACH(ia, INADDR_HASH(in.s_addr), ia_hash) {
127                 if (IA_SIN(ia)->sin_addr.s_addr == in.s_addr) {
128                         IN_IFADDR_RUNLOCK(&in_ifa_tracker);
129                         return (1);
130                 }
131         }
132         IN_IFADDR_RUNLOCK(&in_ifa_tracker);
133         return (0);
134 }
135
136 /*
137  * Return 1 if an internet address is configured on an interface.
138  */
139 int
140 in_ifhasaddr(struct ifnet *ifp, struct in_addr in)
141 {
142         struct ifaddr *ifa;
143         struct in_ifaddr *ia;
144
145         IF_ADDR_RLOCK(ifp);
146         TAILQ_FOREACH(ifa, &ifp->if_addrhead, ifa_link) {
147                 if (ifa->ifa_addr->sa_family != AF_INET)
148                         continue;
149                 ia = (struct in_ifaddr *)ifa;
150                 if (ia->ia_addr.sin_addr.s_addr == in.s_addr) {
151                         IF_ADDR_RUNLOCK(ifp);
152                         return (1);
153                 }
154         }
155         IF_ADDR_RUNLOCK(ifp);
156
157         return (0);
158 }
159
160 /*
161  * Return a reference to the interface address which is different to
162  * the supplied one but with same IP address value.
163  */
164 static struct in_ifaddr *
165 in_localip_more(struct in_ifaddr *ia)
166 {
167         struct rm_priotracker in_ifa_tracker;
168         in_addr_t in = IA_SIN(ia)->sin_addr.s_addr;
169         struct in_ifaddr *it;
170
171         IN_IFADDR_RLOCK(&in_ifa_tracker);
172         LIST_FOREACH(it, INADDR_HASH(in), ia_hash) {
173                 if (it != ia && IA_SIN(it)->sin_addr.s_addr == in) {
174                         ifa_ref(&it->ia_ifa);
175                         IN_IFADDR_RUNLOCK(&in_ifa_tracker);
176                         return (it);
177                 }
178         }
179         IN_IFADDR_RUNLOCK(&in_ifa_tracker);
180
181         return (NULL);
182 }
183
184 /*
185  * Determine whether an IP address is in a reserved set of addresses
186  * that may not be forwarded, or whether datagrams to that destination
187  * may be forwarded.
188  */
189 int
190 in_canforward(struct in_addr in)
191 {
192         u_long i = ntohl(in.s_addr);
193         u_long net;
194
195         if (IN_EXPERIMENTAL(i) || IN_MULTICAST(i) || IN_LINKLOCAL(i))
196                 return (0);
197         if (IN_CLASSA(i)) {
198                 net = i & IN_CLASSA_NET;
199                 if (net == 0 || net == (IN_LOOPBACKNET << IN_CLASSA_NSHIFT))
200                         return (0);
201         }
202         return (1);
203 }
204
205 /*
206  * Trim a mask in a sockaddr
207  */
208 static void
209 in_socktrim(struct sockaddr_in *ap)
210 {
211     char *cplim = (char *) &ap->sin_addr;
212     char *cp = (char *) (&ap->sin_addr + 1);
213
214     ap->sin_len = 0;
215     while (--cp >= cplim)
216         if (*cp) {
217             (ap)->sin_len = cp - (char *) (ap) + 1;
218             break;
219         }
220 }
221
222 /*
223  * Generic internet control operations (ioctl's).
224  */
225 int
226 in_control(struct socket *so, u_long cmd, caddr_t data, struct ifnet *ifp,
227     struct thread *td)
228 {
229         struct ifreq *ifr = (struct ifreq *)data;
230         struct sockaddr_in *addr = (struct sockaddr_in *)&ifr->ifr_addr;
231         struct ifaddr *ifa;
232         struct in_ifaddr *ia;
233         int error;
234
235         if (ifp == NULL)
236                 return (EADDRNOTAVAIL);
237
238         /*
239          * Filter out 4 ioctls we implement directly.  Forward the rest
240          * to specific functions and ifp->if_ioctl().
241          */
242         switch (cmd) {
243         case SIOCGIFADDR:
244         case SIOCGIFBRDADDR:
245         case SIOCGIFDSTADDR:
246         case SIOCGIFNETMASK:
247                 break;
248         case SIOCDIFADDR:
249                 sx_xlock(&in_control_sx);
250                 error = in_difaddr_ioctl(cmd, data, ifp, td);
251                 sx_xunlock(&in_control_sx);
252                 return (error);
253         case OSIOCAIFADDR:      /* 9.x compat */
254         case SIOCAIFADDR:
255                 sx_xlock(&in_control_sx);
256                 error = in_aifaddr_ioctl(cmd, data, ifp, td);
257                 sx_xunlock(&in_control_sx);
258                 return (error);
259         case SIOCSIFADDR:
260         case SIOCSIFBRDADDR:
261         case SIOCSIFDSTADDR:
262         case SIOCSIFNETMASK:
263                 /* We no longer support that old commands. */
264                 return (EINVAL);
265         default:
266                 if (ifp->if_ioctl == NULL)
267                         return (EOPNOTSUPP);
268                 return ((*ifp->if_ioctl)(ifp, cmd, data));
269         }
270
271         if (addr->sin_addr.s_addr != INADDR_ANY &&
272             prison_check_ip4(td->td_ucred, &addr->sin_addr) != 0)
273                 return (EADDRNOTAVAIL);
274
275         /*
276          * Find address for this interface, if it exists.  If an
277          * address was specified, find that one instead of the
278          * first one on the interface, if possible.
279          */
280         IF_ADDR_RLOCK(ifp);
281         TAILQ_FOREACH(ifa, &ifp->if_addrhead, ifa_link) {
282                 if (ifa->ifa_addr->sa_family != AF_INET)
283                         continue;
284                 ia = (struct in_ifaddr *)ifa;
285                 if (ia->ia_addr.sin_addr.s_addr == addr->sin_addr.s_addr)
286                         break;
287         }
288         if (ifa == NULL)
289                 TAILQ_FOREACH(ifa, &ifp->if_addrhead, ifa_link)
290                         if (ifa->ifa_addr->sa_family == AF_INET) {
291                                 ia = (struct in_ifaddr *)ifa;
292                                 if (prison_check_ip4(td->td_ucred,
293                                     &ia->ia_addr.sin_addr) == 0)
294                                         break;
295                         }
296
297         if (ifa == NULL) {
298                 IF_ADDR_RUNLOCK(ifp);
299                 return (EADDRNOTAVAIL);
300         }
301
302         error = 0;
303         switch (cmd) {
304         case SIOCGIFADDR:
305                 *addr = ia->ia_addr;
306                 break;
307
308         case SIOCGIFBRDADDR:
309                 if ((ifp->if_flags & IFF_BROADCAST) == 0) {
310                         error = EINVAL;
311                         break;
312                 }
313                 *addr = ia->ia_broadaddr;
314                 break;
315
316         case SIOCGIFDSTADDR:
317                 if ((ifp->if_flags & IFF_POINTOPOINT) == 0) {
318                         error = EINVAL;
319                         break;
320                 }
321                 *addr = ia->ia_dstaddr;
322                 break;
323
324         case SIOCGIFNETMASK:
325                 *addr = ia->ia_sockmask;
326                 break;
327         }
328
329         IF_ADDR_RUNLOCK(ifp);
330
331         return (error);
332 }
333
334 static int
335 in_aifaddr_ioctl(u_long cmd, caddr_t data, struct ifnet *ifp, struct thread *td)
336 {
337         const struct in_aliasreq *ifra = (struct in_aliasreq *)data;
338         const struct sockaddr_in *addr = &ifra->ifra_addr;
339         const struct sockaddr_in *broadaddr = &ifra->ifra_broadaddr;
340         const struct sockaddr_in *mask = &ifra->ifra_mask;
341         const struct sockaddr_in *dstaddr = &ifra->ifra_dstaddr;
342         const int vhid = (cmd == SIOCAIFADDR) ? ifra->ifra_vhid : 0;
343         struct ifaddr *ifa;
344         struct in_ifaddr *ia;
345         bool iaIsFirst;
346         int error = 0;
347
348         error = priv_check(td, PRIV_NET_ADDIFADDR);
349         if (error)
350                 return (error);
351
352         /*
353          * ifra_addr must be present and be of INET family.
354          * ifra_broadaddr/ifra_dstaddr and ifra_mask are optional.
355          */
356         if (addr->sin_len != sizeof(struct sockaddr_in) ||
357             addr->sin_family != AF_INET)
358                 return (EINVAL);
359         if (broadaddr->sin_len != 0 &&
360             (broadaddr->sin_len != sizeof(struct sockaddr_in) ||
361             broadaddr->sin_family != AF_INET))
362                 return (EINVAL);
363         if (mask->sin_len != 0 &&
364             (mask->sin_len != sizeof(struct sockaddr_in) ||
365             mask->sin_family != AF_INET))
366                 return (EINVAL);
367         if ((ifp->if_flags & IFF_POINTOPOINT) &&
368             (dstaddr->sin_len != sizeof(struct sockaddr_in) ||
369              dstaddr->sin_addr.s_addr == INADDR_ANY))
370                 return (EDESTADDRREQ);
371         if (vhid > 0 && carp_attach_p == NULL)
372                 return (EPROTONOSUPPORT);
373
374         /*
375          * See whether address already exist.
376          */
377         iaIsFirst = true;
378         ia = NULL;
379         IF_ADDR_RLOCK(ifp);
380         TAILQ_FOREACH(ifa, &ifp->if_addrhead, ifa_link) {
381                 struct in_ifaddr *it;
382
383                 if (ifa->ifa_addr->sa_family != AF_INET)
384                         continue;
385
386                 it = (struct in_ifaddr *)ifa;
387                 iaIsFirst = false;
388                 if (it->ia_addr.sin_addr.s_addr == addr->sin_addr.s_addr &&
389                     prison_check_ip4(td->td_ucred, &addr->sin_addr) == 0)
390                         ia = it;
391         }
392         IF_ADDR_RUNLOCK(ifp);
393
394         if (ia != NULL)
395                 (void )in_difaddr_ioctl(cmd, data, ifp, td);
396
397         ifa = ifa_alloc(sizeof(struct in_ifaddr), M_WAITOK);
398         ia = (struct in_ifaddr *)ifa;
399         ifa->ifa_addr = (struct sockaddr *)&ia->ia_addr;
400         ifa->ifa_dstaddr = (struct sockaddr *)&ia->ia_dstaddr;
401         ifa->ifa_netmask = (struct sockaddr *)&ia->ia_sockmask;
402         callout_init_rw(&ia->ia_garp_timer, &ifp->if_addr_lock,
403             CALLOUT_RETURNUNLOCKED);
404
405         ia->ia_ifp = ifp;
406         ia->ia_addr = *addr;
407         if (mask->sin_len != 0) {
408                 ia->ia_sockmask = *mask;
409                 ia->ia_subnetmask = ntohl(ia->ia_sockmask.sin_addr.s_addr);
410         } else {
411                 in_addr_t i = ntohl(addr->sin_addr.s_addr);
412
413                 /*
414                  * Be compatible with network classes, if netmask isn't
415                  * supplied, guess it based on classes.
416                  */
417                 if (IN_CLASSA(i))
418                         ia->ia_subnetmask = IN_CLASSA_NET;
419                 else if (IN_CLASSB(i))
420                         ia->ia_subnetmask = IN_CLASSB_NET;
421                 else
422                         ia->ia_subnetmask = IN_CLASSC_NET;
423                 ia->ia_sockmask.sin_addr.s_addr = htonl(ia->ia_subnetmask);
424         }
425         ia->ia_subnet = ntohl(addr->sin_addr.s_addr) & ia->ia_subnetmask;
426         in_socktrim(&ia->ia_sockmask);
427
428         if (ifp->if_flags & IFF_BROADCAST) {
429                 if (broadaddr->sin_len != 0) {
430                         ia->ia_broadaddr = *broadaddr;
431                 } else if (ia->ia_subnetmask == IN_RFC3021_MASK) {
432                         ia->ia_broadaddr.sin_addr.s_addr = INADDR_BROADCAST;
433                         ia->ia_broadaddr.sin_len = sizeof(struct sockaddr_in);
434                         ia->ia_broadaddr.sin_family = AF_INET;
435                 } else {
436                         ia->ia_broadaddr.sin_addr.s_addr =
437                             htonl(ia->ia_subnet | ~ia->ia_subnetmask);
438                         ia->ia_broadaddr.sin_len = sizeof(struct sockaddr_in);
439                         ia->ia_broadaddr.sin_family = AF_INET;
440                 }
441         }
442
443         if (ifp->if_flags & IFF_POINTOPOINT)
444                 ia->ia_dstaddr = *dstaddr;
445
446         /* XXXGL: rtinit() needs this strange assignment. */
447         if (ifp->if_flags & IFF_LOOPBACK)
448                 ia->ia_dstaddr = ia->ia_addr;
449
450         if (vhid != 0) {
451                 error = (*carp_attach_p)(&ia->ia_ifa, vhid);
452                 if (error)
453                         return (error);
454         }
455
456         /* if_addrhead is already referenced by ifa_alloc() */
457         IF_ADDR_WLOCK(ifp);
458         TAILQ_INSERT_TAIL(&ifp->if_addrhead, ifa, ifa_link);
459         IF_ADDR_WUNLOCK(ifp);
460
461         ifa_ref(ifa);                   /* in_ifaddrhead */
462         IN_IFADDR_WLOCK();
463         TAILQ_INSERT_TAIL(&V_in_ifaddrhead, ia, ia_link);
464         LIST_INSERT_HEAD(INADDR_HASH(ia->ia_addr.sin_addr.s_addr), ia, ia_hash);
465         IN_IFADDR_WUNLOCK();
466
467         /*
468          * Give the interface a chance to initialize
469          * if this is its first address,
470          * and to validate the address if necessary.
471          */
472         if (ifp->if_ioctl != NULL) {
473                 error = (*ifp->if_ioctl)(ifp, SIOCSIFADDR, (caddr_t)ia);
474                 if (error)
475                         goto fail1;
476         }
477
478         /*
479          * Add route for the network.
480          */
481         if (vhid == 0) {
482                 int flags = RTF_UP;
483
484                 if (ifp->if_flags & (IFF_LOOPBACK|IFF_POINTOPOINT))
485                         flags |= RTF_HOST;
486
487                 error = in_addprefix(ia, flags);
488                 if (error)
489                         goto fail1;
490         }
491
492         /*
493          * Add a loopback route to self.
494          */
495         if (vhid == 0 && (ifp->if_flags & IFF_LOOPBACK) == 0 &&
496             ia->ia_addr.sin_addr.s_addr != INADDR_ANY &&
497             !((ifp->if_flags & IFF_POINTOPOINT) &&
498              ia->ia_dstaddr.sin_addr.s_addr == ia->ia_addr.sin_addr.s_addr)) {
499                 struct in_ifaddr *eia;
500
501                 eia = in_localip_more(ia);
502
503                 if (eia == NULL) {
504                         error = ifa_add_loopback_route((struct ifaddr *)ia,
505                             (struct sockaddr *)&ia->ia_addr);
506                         if (error)
507                                 goto fail2;
508                 } else
509                         ifa_free(&eia->ia_ifa);
510         }
511
512         if (iaIsFirst && (ifp->if_flags & IFF_MULTICAST)) {
513                 struct in_addr allhosts_addr;
514                 struct in_ifinfo *ii;
515
516                 ii = ((struct in_ifinfo *)ifp->if_afdata[AF_INET]);
517                 allhosts_addr.s_addr = htonl(INADDR_ALLHOSTS_GROUP);
518
519                 error = in_joingroup(ifp, &allhosts_addr, NULL,
520                         &ii->ii_allhosts);
521         }
522
523         EVENTHANDLER_INVOKE(ifaddr_event, ifp);
524
525         return (error);
526
527 fail2:
528         if (vhid == 0)
529                 (void )in_scrubprefix(ia, LLE_STATIC);
530
531 fail1:
532         if (ia->ia_ifa.ifa_carp)
533                 (*carp_detach_p)(&ia->ia_ifa, false);
534
535         IF_ADDR_WLOCK(ifp);
536         TAILQ_REMOVE(&ifp->if_addrhead, &ia->ia_ifa, ifa_link);
537         IF_ADDR_WUNLOCK(ifp);
538         ifa_free(&ia->ia_ifa);          /* if_addrhead */
539
540         IN_IFADDR_WLOCK();
541         TAILQ_REMOVE(&V_in_ifaddrhead, ia, ia_link);
542         LIST_REMOVE(ia, ia_hash);
543         IN_IFADDR_WUNLOCK();
544         ifa_free(&ia->ia_ifa);          /* in_ifaddrhead */
545
546         return (error);
547 }
548
549 static int
550 in_difaddr_ioctl(u_long cmd, caddr_t data, struct ifnet *ifp, struct thread *td)
551 {
552         const struct ifreq *ifr = (struct ifreq *)data;
553         const struct sockaddr_in *addr = (const struct sockaddr_in *)
554             &ifr->ifr_addr;
555         struct ifaddr *ifa;
556         struct in_ifaddr *ia;
557         bool deleteAny, iaIsLast;
558         int error;
559
560         if (td != NULL) {
561                 error = priv_check(td, PRIV_NET_DELIFADDR);
562                 if (error)
563                         return (error);
564         }
565
566         if (addr->sin_len != sizeof(struct sockaddr_in) ||
567             addr->sin_family != AF_INET)
568                 deleteAny = true;
569         else
570                 deleteAny = false;
571
572         iaIsLast = true;
573         ia = NULL;
574         IF_ADDR_WLOCK(ifp);
575         TAILQ_FOREACH(ifa, &ifp->if_addrhead, ifa_link) {
576                 struct in_ifaddr *it;
577
578                 if (ifa->ifa_addr->sa_family != AF_INET)
579                         continue;
580
581                 it = (struct in_ifaddr *)ifa;
582                 if (deleteAny && ia == NULL && (td == NULL ||
583                     prison_check_ip4(td->td_ucred, &it->ia_addr.sin_addr) == 0))
584                         ia = it;
585
586                 if (it->ia_addr.sin_addr.s_addr == addr->sin_addr.s_addr &&
587                     (td == NULL || prison_check_ip4(td->td_ucred,
588                     &addr->sin_addr) == 0))
589                         ia = it;
590
591                 if (it != ia)
592                         iaIsLast = false;
593         }
594
595         if (ia == NULL) {
596                 IF_ADDR_WUNLOCK(ifp);
597                 return (EADDRNOTAVAIL);
598         }
599
600         TAILQ_REMOVE(&ifp->if_addrhead, &ia->ia_ifa, ifa_link);
601         IF_ADDR_WUNLOCK(ifp);
602         ifa_free(&ia->ia_ifa);          /* if_addrhead */
603
604         IN_IFADDR_WLOCK();
605         TAILQ_REMOVE(&V_in_ifaddrhead, ia, ia_link);
606         LIST_REMOVE(ia, ia_hash);
607         IN_IFADDR_WUNLOCK();
608
609         /*
610          * in_scrubprefix() kills the interface route.
611          */
612         in_scrubprefix(ia, LLE_STATIC);
613
614         /*
615          * in_ifadown gets rid of all the rest of
616          * the routes.  This is not quite the right
617          * thing to do, but at least if we are running
618          * a routing process they will come back.
619          */
620         in_ifadown(&ia->ia_ifa, 1);
621
622         if (ia->ia_ifa.ifa_carp)
623                 (*carp_detach_p)(&ia->ia_ifa,
624                     (cmd == SIOCDIFADDR) ? false : true);
625
626         /*
627          * If this is the last IPv4 address configured on this
628          * interface, leave the all-hosts group.
629          * No state-change report need be transmitted.
630          */
631         if (iaIsLast && (ifp->if_flags & IFF_MULTICAST)) {
632                 struct in_ifinfo *ii;
633
634                 ii = ((struct in_ifinfo *)ifp->if_afdata[AF_INET]);
635                 if (ii->ii_allhosts) {
636                         (void)in_leavegroup(ii->ii_allhosts, NULL);
637                         ii->ii_allhosts = NULL;
638                 }
639         }
640
641         IF_ADDR_WLOCK(ifp);
642         if (callout_stop(&ia->ia_garp_timer) == 1) {
643                 ifa_free(&ia->ia_ifa);
644         }
645         IF_ADDR_WUNLOCK(ifp);
646
647         EVENTHANDLER_INVOKE(ifaddr_event, ifp);
648         ifa_free(&ia->ia_ifa);          /* in_ifaddrhead */
649
650         return (0);
651 }
652
653 #define rtinitflags(x) \
654         ((((x)->ia_ifp->if_flags & (IFF_LOOPBACK | IFF_POINTOPOINT)) != 0) \
655             ? RTF_HOST : 0)
656
657 /*
658  * Check if we have a route for the given prefix already or add one accordingly.
659  */
660 int
661 in_addprefix(struct in_ifaddr *target, int flags)
662 {
663         struct rm_priotracker in_ifa_tracker;
664         struct in_ifaddr *ia;
665         struct in_addr prefix, mask, p, m;
666         int error;
667
668         if ((flags & RTF_HOST) != 0) {
669                 prefix = target->ia_dstaddr.sin_addr;
670                 mask.s_addr = 0;
671         } else {
672                 prefix = target->ia_addr.sin_addr;
673                 mask = target->ia_sockmask.sin_addr;
674                 prefix.s_addr &= mask.s_addr;
675         }
676
677         IN_IFADDR_RLOCK(&in_ifa_tracker);
678         /* Look for an existing address with the same prefix, mask, and fib */
679         TAILQ_FOREACH(ia, &V_in_ifaddrhead, ia_link) {
680                 if (rtinitflags(ia)) {
681                         p = ia->ia_dstaddr.sin_addr;
682
683                         if (prefix.s_addr != p.s_addr)
684                                 continue;
685                 } else {
686                         p = ia->ia_addr.sin_addr;
687                         m = ia->ia_sockmask.sin_addr;
688                         p.s_addr &= m.s_addr;
689
690                         if (prefix.s_addr != p.s_addr ||
691                             mask.s_addr != m.s_addr)
692                                 continue;
693                 }
694                 if (target->ia_ifp->if_fib != ia->ia_ifp->if_fib)
695                         continue;
696
697                 /*
698                  * If we got a matching prefix route inserted by other
699                  * interface address, we are done here.
700                  */
701                 if (ia->ia_flags & IFA_ROUTE) {
702 #ifdef RADIX_MPATH
703                         if (ia->ia_addr.sin_addr.s_addr ==
704                             target->ia_addr.sin_addr.s_addr) {
705                                 IN_IFADDR_RUNLOCK(&in_ifa_tracker);
706                                 return (EEXIST);
707                         } else
708                                 break;
709 #endif
710                         if (V_nosameprefix) {
711                                 IN_IFADDR_RUNLOCK(&in_ifa_tracker);
712                                 return (EEXIST);
713                         } else {
714                                 int fibnum;
715
716                                 fibnum = V_rt_add_addr_allfibs ? RT_ALL_FIBS :
717                                         target->ia_ifp->if_fib;
718                                 rt_addrmsg(RTM_ADD, &target->ia_ifa, fibnum);
719                                 IN_IFADDR_RUNLOCK(&in_ifa_tracker);
720                                 return (0);
721                         }
722                 }
723         }
724         IN_IFADDR_RUNLOCK(&in_ifa_tracker);
725
726         /*
727          * No-one seem to have this prefix route, so we try to insert it.
728          */
729         error = rtinit(&target->ia_ifa, (int)RTM_ADD, flags);
730         if (!error)
731                 target->ia_flags |= IFA_ROUTE;
732         return (error);
733 }
734
735 /*
736  * Removes either all lle entries for given @ia, or lle
737  * corresponding to @ia address.
738  */
739 static void
740 in_scrubprefixlle(struct in_ifaddr *ia, int all, u_int flags)
741 {
742         struct sockaddr_in addr, mask;
743         struct sockaddr *saddr, *smask;
744         struct ifnet *ifp;
745
746         saddr = (struct sockaddr *)&addr;
747         bzero(&addr, sizeof(addr));
748         addr.sin_len = sizeof(addr);
749         addr.sin_family = AF_INET;
750         smask = (struct sockaddr *)&mask;
751         bzero(&mask, sizeof(mask));
752         mask.sin_len = sizeof(mask);
753         mask.sin_family = AF_INET;
754         mask.sin_addr.s_addr = ia->ia_subnetmask;
755         ifp = ia->ia_ifp;
756
757         if (all) {
758
759                 /*
760                  * Remove all L2 entries matching given prefix.
761                  * Convert address to host representation to avoid
762                  * doing this on every callback. ia_subnetmask is already
763                  * stored in host representation.
764                  */
765                 addr.sin_addr.s_addr = ntohl(ia->ia_addr.sin_addr.s_addr);
766                 lltable_prefix_free(AF_INET, saddr, smask, flags);
767         } else {
768                 /* Remove interface address only */
769                 addr.sin_addr.s_addr = ia->ia_addr.sin_addr.s_addr;
770                 lltable_delete_addr(LLTABLE(ifp), LLE_IFADDR, saddr);
771         }
772 }
773
774 /*
775  * If there is no other address in the system that can serve a route to the
776  * same prefix, remove the route.  Hand over the route to the new address
777  * otherwise.
778  */
779 int
780 in_scrubprefix(struct in_ifaddr *target, u_int flags)
781 {
782         struct rm_priotracker in_ifa_tracker;
783         struct in_ifaddr *ia;
784         struct in_addr prefix, mask, p, m;
785         int error = 0;
786
787         /*
788          * Remove the loopback route to the interface address.
789          */
790         if ((target->ia_addr.sin_addr.s_addr != INADDR_ANY) &&
791             !(target->ia_ifp->if_flags & IFF_LOOPBACK) &&
792             (flags & LLE_STATIC)) {
793                 struct in_ifaddr *eia;
794
795                 /*
796                  * XXXME: add fib-aware in_localip.
797                  * We definitely don't want to switch between
798                  * prefixes in different fibs.
799                  */
800                 eia = in_localip_more(target);
801
802                 if (eia != NULL) {
803                         error = ifa_switch_loopback_route((struct ifaddr *)eia,
804                             (struct sockaddr *)&target->ia_addr);
805                         ifa_free(&eia->ia_ifa);
806                 } else {
807                         error = ifa_del_loopback_route((struct ifaddr *)target,
808                             (struct sockaddr *)&target->ia_addr);
809                 }
810         }
811
812         if (rtinitflags(target)) {
813                 prefix = target->ia_dstaddr.sin_addr;
814                 mask.s_addr = 0;
815         } else {
816                 prefix = target->ia_addr.sin_addr;
817                 mask = target->ia_sockmask.sin_addr;
818                 prefix.s_addr &= mask.s_addr;
819         }
820
821         if ((target->ia_flags & IFA_ROUTE) == 0) {
822                 int fibnum;
823                 
824                 fibnum = V_rt_add_addr_allfibs ? RT_ALL_FIBS :
825                         target->ia_ifp->if_fib;
826                 rt_addrmsg(RTM_DELETE, &target->ia_ifa, fibnum);
827         
828                 /*
829                  * Removing address from !IFF_UP interface or
830                  * prefix which exists on other interface (along with route).
831                  * No entries should exist here except target addr.
832                  * Given that, delete this entry only.
833                  */
834                 in_scrubprefixlle(target, 0, flags);
835                 return (0);
836         }
837
838         IN_IFADDR_RLOCK(&in_ifa_tracker);
839         TAILQ_FOREACH(ia, &V_in_ifaddrhead, ia_link) {
840                 if (rtinitflags(ia)) {
841                         p = ia->ia_dstaddr.sin_addr;
842
843                         if (prefix.s_addr != p.s_addr)
844                                 continue;
845                 } else {
846                         p = ia->ia_addr.sin_addr;
847                         m = ia->ia_sockmask.sin_addr;
848                         p.s_addr &= m.s_addr;
849
850                         if (prefix.s_addr != p.s_addr ||
851                             mask.s_addr != m.s_addr)
852                                 continue;
853                 }
854
855                 if ((ia->ia_ifp->if_flags & IFF_UP) == 0)
856                         continue;
857
858                 /*
859                  * If we got a matching prefix address, move IFA_ROUTE and
860                  * the route itself to it.  Make sure that routing daemons
861                  * get a heads-up.
862                  */
863                 if ((ia->ia_flags & IFA_ROUTE) == 0) {
864                         ifa_ref(&ia->ia_ifa);
865                         IN_IFADDR_RUNLOCK(&in_ifa_tracker);
866                         error = rtinit(&(target->ia_ifa), (int)RTM_DELETE,
867                             rtinitflags(target));
868                         if (error == 0)
869                                 target->ia_flags &= ~IFA_ROUTE;
870                         else
871                                 log(LOG_INFO, "in_scrubprefix: err=%d, old prefix delete failed\n",
872                                         error);
873                         /* Scrub all entries IFF interface is different */
874                         in_scrubprefixlle(target, target->ia_ifp != ia->ia_ifp,
875                             flags);
876                         error = rtinit(&ia->ia_ifa, (int)RTM_ADD,
877                             rtinitflags(ia) | RTF_UP);
878                         if (error == 0)
879                                 ia->ia_flags |= IFA_ROUTE;
880                         else
881                                 log(LOG_INFO, "in_scrubprefix: err=%d, new prefix add failed\n",
882                                         error);
883                         ifa_free(&ia->ia_ifa);
884                         return (error);
885                 }
886         }
887         IN_IFADDR_RUNLOCK(&in_ifa_tracker);
888
889         /*
890          * remove all L2 entries on the given prefix
891          */
892         in_scrubprefixlle(target, 1, flags);
893
894         /*
895          * As no-one seem to have this prefix, we can remove the route.
896          */
897         error = rtinit(&(target->ia_ifa), (int)RTM_DELETE, rtinitflags(target));
898         if (error == 0)
899                 target->ia_flags &= ~IFA_ROUTE;
900         else
901                 log(LOG_INFO, "in_scrubprefix: err=%d, prefix delete failed\n", error);
902         return (error);
903 }
904
905 #undef rtinitflags
906
907 void
908 in_ifscrub_all(void)
909 {
910         struct ifnet *ifp;
911         struct ifaddr *ifa, *nifa;
912         struct ifaliasreq ifr;
913
914         IFNET_RLOCK();
915         TAILQ_FOREACH(ifp, &V_ifnet, if_link) {
916                 /* Cannot lock here - lock recursion. */
917                 /* IF_ADDR_RLOCK(ifp); */
918                 TAILQ_FOREACH_SAFE(ifa, &ifp->if_addrhead, ifa_link, nifa) {
919                         if (ifa->ifa_addr->sa_family != AF_INET)
920                                 continue;
921
922                         /*
923                          * This is ugly but the only way for legacy IP to
924                          * cleanly remove addresses and everything attached.
925                          */
926                         bzero(&ifr, sizeof(ifr));
927                         ifr.ifra_addr = *ifa->ifa_addr;
928                         if (ifa->ifa_dstaddr)
929                         ifr.ifra_broadaddr = *ifa->ifa_dstaddr;
930                         (void)in_control(NULL, SIOCDIFADDR, (caddr_t)&ifr,
931                             ifp, NULL);
932                 }
933                 /* IF_ADDR_RUNLOCK(ifp); */
934                 in_purgemaddrs(ifp);
935                 igmp_domifdetach(ifp);
936         }
937         IFNET_RUNLOCK();
938 }
939
940 int
941 in_ifaddr_broadcast(struct in_addr in, struct in_ifaddr *ia)
942 {
943
944         return ((in.s_addr == ia->ia_broadaddr.sin_addr.s_addr ||
945              /*
946               * Check for old-style (host 0) broadcast, but
947               * taking into account that RFC 3021 obsoletes it.
948               */
949             (ia->ia_subnetmask != IN_RFC3021_MASK &&
950             ntohl(in.s_addr) == ia->ia_subnet)) &&
951              /*
952               * Check for an all one subnetmask. These
953               * only exist when an interface gets a secondary
954               * address.
955               */
956             ia->ia_subnetmask != (u_long)0xffffffff);
957 }
958
959 /*
960  * Return 1 if the address might be a local broadcast address.
961  */
962 int
963 in_broadcast(struct in_addr in, struct ifnet *ifp)
964 {
965         struct ifaddr *ifa;
966         int found;
967
968         if (in.s_addr == INADDR_BROADCAST ||
969             in.s_addr == INADDR_ANY)
970                 return (1);
971         if ((ifp->if_flags & IFF_BROADCAST) == 0)
972                 return (0);
973         found = 0;
974         /*
975          * Look through the list of addresses for a match
976          * with a broadcast address.
977          */
978         IF_ADDR_RLOCK(ifp);
979         TAILQ_FOREACH(ifa, &ifp->if_addrhead, ifa_link)
980                 if (ifa->ifa_addr->sa_family == AF_INET &&
981                     in_ifaddr_broadcast(in, (struct in_ifaddr *)ifa)) {
982                         found = 1;
983                         break;
984                 }
985         IF_ADDR_RUNLOCK(ifp);
986         return (found);
987 }
988
989 /*
990  * On interface removal, clean up IPv4 data structures hung off of the ifnet.
991  */
992 void
993 in_ifdetach(struct ifnet *ifp)
994 {
995         IN_MULTI_LOCK();
996         in_pcbpurgeif0(&V_ripcbinfo, ifp);
997         in_pcbpurgeif0(&V_udbinfo, ifp);
998         in_pcbpurgeif0(&V_ulitecbinfo, ifp);
999         in_purgemaddrs(ifp);
1000         IN_MULTI_UNLOCK();
1001 }
1002
1003 /*
1004  * Delete all IPv4 multicast address records, and associated link-layer
1005  * multicast address records, associated with ifp.
1006  * XXX It looks like domifdetach runs AFTER the link layer cleanup.
1007  * XXX This should not race with ifma_protospec being set during
1008  * a new allocation, if it does, we have bigger problems.
1009  */
1010 static void
1011 in_purgemaddrs(struct ifnet *ifp)
1012 {
1013         struct in_multi_head purgeinms;
1014         struct in_multi         *inm;
1015         struct ifmultiaddr      *ifma, *next;
1016
1017         SLIST_INIT(&purgeinms);
1018         IN_MULTI_LIST_LOCK();
1019
1020         /*
1021          * Extract list of in_multi associated with the detaching ifp
1022          * which the PF_INET layer is about to release.
1023          * We need to do this as IF_ADDR_LOCK() may be re-acquired
1024          * by code further down.
1025          */
1026         IF_ADDR_WLOCK(ifp);
1027  restart:
1028         TAILQ_FOREACH_SAFE(ifma, &ifp->if_multiaddrs, ifma_link, next) {
1029                 if (ifma->ifma_addr->sa_family != AF_INET ||
1030                     ifma->ifma_protospec == NULL)
1031                         continue;
1032                 inm = (struct in_multi *)ifma->ifma_protospec;
1033                 inm_rele_locked(&purgeinms, inm);
1034                 if (__predict_false(ifma_restart)) {
1035                         ifma_restart = true;
1036                         goto restart;
1037                 }
1038         }
1039         IF_ADDR_WUNLOCK(ifp);
1040
1041         inm_release_list_deferred(&purgeinms);
1042         igmp_ifdetach(ifp);
1043         IN_MULTI_LIST_UNLOCK();
1044 }
1045
1046 struct in_llentry {
1047         struct llentry          base;
1048 };
1049
1050 #define IN_LLTBL_DEFAULT_HSIZE  32
1051 #define IN_LLTBL_HASH(k, h) \
1052         (((((((k >> 8) ^ k) >> 8) ^ k) >> 8) ^ k) & ((h) - 1))
1053
1054 /*
1055  * Do actual deallocation of @lle.
1056  */
1057 static void
1058 in_lltable_destroy_lle_unlocked(struct llentry *lle)
1059 {
1060
1061         LLE_LOCK_DESTROY(lle);
1062         LLE_REQ_DESTROY(lle);
1063         free(lle, M_LLTABLE);
1064 }
1065
1066 /*
1067  * Called by the datapath to indicate that
1068  * the entry was used.
1069  */
1070 static void
1071 in_lltable_mark_used(struct llentry *lle)
1072 {
1073
1074         LLE_REQ_LOCK(lle);
1075         lle->r_skip_req = 0;
1076         LLE_REQ_UNLOCK(lle);
1077 }
1078
1079 /*
1080  * Called by LLE_FREE_LOCKED when number of references
1081  * drops to zero.
1082  */
1083 static void
1084 in_lltable_destroy_lle(struct llentry *lle)
1085 {
1086
1087         LLE_WUNLOCK(lle);
1088         in_lltable_destroy_lle_unlocked(lle);
1089 }
1090
1091 static struct llentry *
1092 in_lltable_new(struct in_addr addr4, u_int flags)
1093 {
1094         struct in_llentry *lle;
1095
1096         lle = malloc(sizeof(struct in_llentry), M_LLTABLE, M_NOWAIT | M_ZERO);
1097         if (lle == NULL)                /* NB: caller generates msg */
1098                 return NULL;
1099
1100         /*
1101          * For IPv4 this will trigger "arpresolve" to generate
1102          * an ARP request.
1103          */
1104         lle->base.la_expire = time_uptime; /* mark expired */
1105         lle->base.r_l3addr.addr4 = addr4;
1106         lle->base.lle_refcnt = 1;
1107         lle->base.lle_free = in_lltable_destroy_lle;
1108         LLE_LOCK_INIT(&lle->base);
1109         LLE_REQ_INIT(&lle->base);
1110         callout_init(&lle->base.lle_timer, 1);
1111
1112         return (&lle->base);
1113 }
1114
1115 #define IN_ARE_MASKED_ADDR_EQUAL(d, a, m)       (               \
1116         ((((d).s_addr ^ (a).s_addr) & (m).s_addr)) == 0 )
1117
1118 static int
1119 in_lltable_match_prefix(const struct sockaddr *saddr,
1120     const struct sockaddr *smask, u_int flags, struct llentry *lle)
1121 {
1122         struct in_addr addr, mask, lle_addr;
1123
1124         addr = ((const struct sockaddr_in *)saddr)->sin_addr;
1125         mask = ((const struct sockaddr_in *)smask)->sin_addr;
1126         lle_addr.s_addr = ntohl(lle->r_l3addr.addr4.s_addr);
1127
1128         if (IN_ARE_MASKED_ADDR_EQUAL(lle_addr, addr, mask) == 0)
1129                 return (0);
1130
1131         if (lle->la_flags & LLE_IFADDR) {
1132
1133                 /*
1134                  * Delete LLE_IFADDR records IFF address & flag matches.
1135                  * Note that addr is the interface address within prefix
1136                  * being matched.
1137                  * Note also we should handle 'ifdown' cases without removing
1138                  * ifaddr macs.
1139                  */
1140                 if (addr.s_addr == lle_addr.s_addr && (flags & LLE_STATIC) != 0)
1141                         return (1);
1142                 return (0);
1143         }
1144
1145         /* flags & LLE_STATIC means deleting both dynamic and static entries */
1146         if ((flags & LLE_STATIC) || !(lle->la_flags & LLE_STATIC))
1147                 return (1);
1148
1149         return (0);
1150 }
1151
1152 static void
1153 in_lltable_free_entry(struct lltable *llt, struct llentry *lle)
1154 {
1155         struct ifnet *ifp;
1156         size_t pkts_dropped;
1157
1158         LLE_WLOCK_ASSERT(lle);
1159         KASSERT(llt != NULL, ("lltable is NULL"));
1160
1161         /* Unlink entry from table if not already */
1162         if ((lle->la_flags & LLE_LINKED) != 0) {
1163                 ifp = llt->llt_ifp;
1164                 IF_AFDATA_WLOCK_ASSERT(ifp);
1165                 lltable_unlink_entry(llt, lle);
1166         }
1167
1168         /* cancel timer */
1169         if (callout_stop(&lle->lle_timer) > 0)
1170                 LLE_REMREF(lle);
1171
1172         /* Drop hold queue */
1173         pkts_dropped = llentry_free(lle);
1174         ARPSTAT_ADD(dropped, pkts_dropped);
1175 }
1176
1177 static int
1178 in_lltable_rtcheck(struct ifnet *ifp, u_int flags, const struct sockaddr *l3addr)
1179 {
1180         struct rt_addrinfo info;
1181         struct sockaddr_in rt_key, rt_mask;
1182         struct sockaddr rt_gateway;
1183         int rt_flags;
1184
1185         KASSERT(l3addr->sa_family == AF_INET,
1186             ("sin_family %d", l3addr->sa_family));
1187
1188         bzero(&rt_key, sizeof(rt_key));
1189         rt_key.sin_len = sizeof(rt_key);
1190         bzero(&rt_mask, sizeof(rt_mask));
1191         rt_mask.sin_len = sizeof(rt_mask);
1192         bzero(&rt_gateway, sizeof(rt_gateway));
1193         rt_gateway.sa_len = sizeof(rt_gateway);
1194
1195         bzero(&info, sizeof(info));
1196         info.rti_info[RTAX_DST] = (struct sockaddr *)&rt_key;
1197         info.rti_info[RTAX_NETMASK] = (struct sockaddr *)&rt_mask;
1198         info.rti_info[RTAX_GATEWAY] = (struct sockaddr *)&rt_gateway;
1199
1200         if (rib_lookup_info(ifp->if_fib, l3addr, NHR_REF, 0, &info) != 0)
1201                 return (EINVAL);
1202
1203         rt_flags = info.rti_flags;
1204
1205         /*
1206          * If the gateway for an existing host route matches the target L3
1207          * address, which is a special route inserted by some implementation
1208          * such as MANET, and the interface is of the correct type, then
1209          * allow for ARP to proceed.
1210          */
1211         if (rt_flags & RTF_GATEWAY) {
1212                 if (!(rt_flags & RTF_HOST) || !info.rti_ifp ||
1213                     info.rti_ifp->if_type != IFT_ETHER ||
1214                     (info.rti_ifp->if_flags & (IFF_NOARP | IFF_STATICARP)) != 0 ||
1215                     memcmp(rt_gateway.sa_data, l3addr->sa_data,
1216                     sizeof(in_addr_t)) != 0) {
1217                         rib_free_info(&info);
1218                         return (EINVAL);
1219                 }
1220         }
1221         rib_free_info(&info);
1222
1223         /*
1224          * Make sure that at least the destination address is covered
1225          * by the route. This is for handling the case where 2 or more
1226          * interfaces have the same prefix. An incoming packet arrives
1227          * on one interface and the corresponding outgoing packet leaves
1228          * another interface.
1229          */
1230         if (!(rt_flags & RTF_HOST) && info.rti_ifp != ifp) {
1231                 const char *sa, *mask, *addr, *lim;
1232                 const struct sockaddr_in *l3sin;
1233
1234                 mask = (const char *)&rt_mask;
1235                 /*
1236                  * Just being extra cautious to avoid some custom
1237                  * code getting into trouble.
1238                  */
1239                 if ((info.rti_addrs & RTA_NETMASK) == 0)
1240                         return (EINVAL);
1241
1242                 sa = (const char *)&rt_key;
1243                 addr = (const char *)l3addr;
1244                 l3sin = (const struct sockaddr_in *)l3addr;
1245                 lim = addr + l3sin->sin_len;
1246
1247                 for ( ; addr < lim; sa++, mask++, addr++) {
1248                         if ((*sa ^ *addr) & *mask) {
1249 #ifdef DIAGNOSTIC
1250                                 char addrbuf[INET_ADDRSTRLEN];
1251
1252                                 log(LOG_INFO, "IPv4 address: \"%s\" "
1253                                     "is not on the network\n",
1254                                     inet_ntoa_r(l3sin->sin_addr, addrbuf));
1255 #endif
1256                                 return (EINVAL);
1257                         }
1258                 }
1259         }
1260
1261         return (0);
1262 }
1263
1264 static inline uint32_t
1265 in_lltable_hash_dst(const struct in_addr dst, uint32_t hsize)
1266 {
1267
1268         return (IN_LLTBL_HASH(dst.s_addr, hsize));
1269 }
1270
1271 static uint32_t
1272 in_lltable_hash(const struct llentry *lle, uint32_t hsize)
1273 {
1274
1275         return (in_lltable_hash_dst(lle->r_l3addr.addr4, hsize));
1276 }
1277
1278 static void
1279 in_lltable_fill_sa_entry(const struct llentry *lle, struct sockaddr *sa)
1280 {
1281         struct sockaddr_in *sin;
1282
1283         sin = (struct sockaddr_in *)sa;
1284         bzero(sin, sizeof(*sin));
1285         sin->sin_family = AF_INET;
1286         sin->sin_len = sizeof(*sin);
1287         sin->sin_addr = lle->r_l3addr.addr4;
1288 }
1289
1290 static inline struct llentry *
1291 in_lltable_find_dst(struct lltable *llt, struct in_addr dst)
1292 {
1293         struct llentry *lle;
1294         struct llentries *lleh;
1295         u_int hashidx;
1296
1297         hashidx = in_lltable_hash_dst(dst, llt->llt_hsize);
1298         lleh = &llt->lle_head[hashidx];
1299         LIST_FOREACH(lle, lleh, lle_next) {
1300                 if (lle->la_flags & LLE_DELETED)
1301                         continue;
1302                 if (lle->r_l3addr.addr4.s_addr == dst.s_addr)
1303                         break;
1304         }
1305
1306         return (lle);
1307 }
1308
1309 static void
1310 in_lltable_delete_entry(struct lltable *llt, struct llentry *lle)
1311 {
1312
1313         lle->la_flags |= LLE_DELETED;
1314         EVENTHANDLER_INVOKE(lle_event, lle, LLENTRY_DELETED);
1315 #ifdef DIAGNOSTIC
1316         log(LOG_INFO, "ifaddr cache = %p is deleted\n", lle);
1317 #endif
1318         llentry_free(lle);
1319 }
1320
1321 static struct llentry *
1322 in_lltable_alloc(struct lltable *llt, u_int flags, const struct sockaddr *l3addr)
1323 {
1324         const struct sockaddr_in *sin = (const struct sockaddr_in *)l3addr;
1325         struct ifnet *ifp = llt->llt_ifp;
1326         struct llentry *lle;
1327         char linkhdr[LLE_MAX_LINKHDR];
1328         size_t linkhdrsize;
1329         int lladdr_off;
1330
1331         KASSERT(l3addr->sa_family == AF_INET,
1332             ("sin_family %d", l3addr->sa_family));
1333
1334         /*
1335          * A route that covers the given address must have
1336          * been installed 1st because we are doing a resolution,
1337          * verify this.
1338          */
1339         if (!(flags & LLE_IFADDR) &&
1340             in_lltable_rtcheck(ifp, flags, l3addr) != 0)
1341                 return (NULL);
1342
1343         lle = in_lltable_new(sin->sin_addr, flags);
1344         if (lle == NULL) {
1345                 log(LOG_INFO, "lla_lookup: new lle malloc failed\n");
1346                 return (NULL);
1347         }
1348         lle->la_flags = flags;
1349         if (flags & LLE_STATIC)
1350                 lle->r_flags |= RLLE_VALID;
1351         if ((flags & LLE_IFADDR) == LLE_IFADDR) {
1352                 linkhdrsize = LLE_MAX_LINKHDR;
1353                 if (lltable_calc_llheader(ifp, AF_INET, IF_LLADDR(ifp),
1354                     linkhdr, &linkhdrsize, &lladdr_off) != 0) {
1355                         in_lltable_destroy_lle_unlocked(lle);
1356                         return (NULL);
1357                 }
1358                 lltable_set_entry_addr(ifp, lle, linkhdr, linkhdrsize,
1359                     lladdr_off);
1360                 lle->la_flags |= LLE_STATIC;
1361                 lle->r_flags |= (RLLE_VALID | RLLE_IFADDR);
1362         }
1363
1364         return (lle);
1365 }
1366
1367 /*
1368  * Return NULL if not found or marked for deletion.
1369  * If found return lle read locked.
1370  */
1371 static struct llentry *
1372 in_lltable_lookup(struct lltable *llt, u_int flags, const struct sockaddr *l3addr)
1373 {
1374         const struct sockaddr_in *sin = (const struct sockaddr_in *)l3addr;
1375         struct llentry *lle;
1376
1377         IF_AFDATA_LOCK_ASSERT(llt->llt_ifp);
1378         KASSERT(l3addr->sa_family == AF_INET,
1379             ("sin_family %d", l3addr->sa_family));
1380         lle = in_lltable_find_dst(llt, sin->sin_addr);
1381
1382         if (lle == NULL)
1383                 return (NULL);
1384
1385         KASSERT((flags & (LLE_UNLOCKED|LLE_EXCLUSIVE)) !=
1386             (LLE_UNLOCKED|LLE_EXCLUSIVE),("wrong lle request flags: 0x%X",
1387             flags));
1388
1389         if (flags & LLE_UNLOCKED)
1390                 return (lle);
1391
1392         if (flags & LLE_EXCLUSIVE)
1393                 LLE_WLOCK(lle);
1394         else
1395                 LLE_RLOCK(lle);
1396
1397         return (lle);
1398 }
1399
1400 static int
1401 in_lltable_dump_entry(struct lltable *llt, struct llentry *lle,
1402     struct sysctl_req *wr)
1403 {
1404         struct ifnet *ifp = llt->llt_ifp;
1405         /* XXX stack use */
1406         struct {
1407                 struct rt_msghdr        rtm;
1408                 struct sockaddr_in      sin;
1409                 struct sockaddr_dl      sdl;
1410         } arpc;
1411         struct sockaddr_dl *sdl;
1412         int error;
1413
1414         bzero(&arpc, sizeof(arpc));
1415                         /* skip deleted entries */
1416                         if ((lle->la_flags & LLE_DELETED) == LLE_DELETED)
1417                                 return (0);
1418                         /* Skip if jailed and not a valid IP of the prison. */
1419                         lltable_fill_sa_entry(lle,(struct sockaddr *)&arpc.sin);
1420                         if (prison_if(wr->td->td_ucred,
1421                             (struct sockaddr *)&arpc.sin) != 0)
1422                                 return (0);
1423                         /*
1424                          * produce a msg made of:
1425                          *  struct rt_msghdr;
1426                          *  struct sockaddr_in; (IPv4)
1427                          *  struct sockaddr_dl;
1428                          */
1429                         arpc.rtm.rtm_msglen = sizeof(arpc);
1430                         arpc.rtm.rtm_version = RTM_VERSION;
1431                         arpc.rtm.rtm_type = RTM_GET;
1432                         arpc.rtm.rtm_flags = RTF_UP;
1433                         arpc.rtm.rtm_addrs = RTA_DST | RTA_GATEWAY;
1434
1435                         /* publish */
1436                         if (lle->la_flags & LLE_PUB)
1437                                 arpc.rtm.rtm_flags |= RTF_ANNOUNCE;
1438
1439                         sdl = &arpc.sdl;
1440                         sdl->sdl_family = AF_LINK;
1441                         sdl->sdl_len = sizeof(*sdl);
1442                         sdl->sdl_index = ifp->if_index;
1443                         sdl->sdl_type = ifp->if_type;
1444                         if ((lle->la_flags & LLE_VALID) == LLE_VALID) {
1445                                 sdl->sdl_alen = ifp->if_addrlen;
1446                                 bcopy(lle->ll_addr, LLADDR(sdl), ifp->if_addrlen);
1447                         } else {
1448                                 sdl->sdl_alen = 0;
1449                                 bzero(LLADDR(sdl), ifp->if_addrlen);
1450                         }
1451
1452                         arpc.rtm.rtm_rmx.rmx_expire =
1453                             lle->la_flags & LLE_STATIC ? 0 : lle->la_expire;
1454                         arpc.rtm.rtm_flags |= (RTF_HOST | RTF_LLDATA);
1455                         if (lle->la_flags & LLE_STATIC)
1456                                 arpc.rtm.rtm_flags |= RTF_STATIC;
1457                         if (lle->la_flags & LLE_IFADDR)
1458                                 arpc.rtm.rtm_flags |= RTF_PINNED;
1459                         arpc.rtm.rtm_index = ifp->if_index;
1460                         error = SYSCTL_OUT(wr, &arpc, sizeof(arpc));
1461
1462         return (error);
1463 }
1464
1465 static struct lltable *
1466 in_lltattach(struct ifnet *ifp)
1467 {
1468         struct lltable *llt;
1469
1470         llt = lltable_allocate_htbl(IN_LLTBL_DEFAULT_HSIZE);
1471         llt->llt_af = AF_INET;
1472         llt->llt_ifp = ifp;
1473
1474         llt->llt_lookup = in_lltable_lookup;
1475         llt->llt_alloc_entry = in_lltable_alloc;
1476         llt->llt_delete_entry = in_lltable_delete_entry;
1477         llt->llt_dump_entry = in_lltable_dump_entry;
1478         llt->llt_hash = in_lltable_hash;
1479         llt->llt_fill_sa_entry = in_lltable_fill_sa_entry;
1480         llt->llt_free_entry = in_lltable_free_entry;
1481         llt->llt_match_prefix = in_lltable_match_prefix;
1482         llt->llt_mark_used = in_lltable_mark_used;
1483         lltable_link(llt);
1484
1485         return (llt);
1486 }
1487
1488 void *
1489 in_domifattach(struct ifnet *ifp)
1490 {
1491         struct in_ifinfo *ii;
1492
1493         ii = malloc(sizeof(struct in_ifinfo), M_IFADDR, M_WAITOK|M_ZERO);
1494
1495         ii->ii_llt = in_lltattach(ifp);
1496         ii->ii_igmp = igmp_domifattach(ifp);
1497
1498         return (ii);
1499 }
1500
1501 void
1502 in_domifdetach(struct ifnet *ifp, void *aux)
1503 {
1504         struct in_ifinfo *ii = (struct in_ifinfo *)aux;
1505
1506         igmp_domifdetach(ifp);
1507         lltable_free(ii->ii_llt);
1508         free(ii, M_IFADDR);
1509 }