Parallelize in_ifaddrhashtbl
[dragonfly.git] / sys / netinet / in.c
1 /*
2  * Copyright (c) 1982, 1986, 1991, 1993
3  *      The Regents of the University of California.  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. All advertising materials mentioning features or use of this software
14  *    must display the following acknowledgement:
15  *      This product includes software developed by the University of
16  *      California, Berkeley and its contributors.
17  * 4. Neither the name of the University nor the names of its contributors
18  *    may be used to endorse or promote products derived from this software
19  *    without specific prior written permission.
20  *
21  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
22  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
23  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
24  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
25  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
26  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
27  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
28  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
29  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
30  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
31  * SUCH DAMAGE.
32  *
33  *      @(#)in.c        8.4 (Berkeley) 1/9/95
34  * $FreeBSD: src/sys/netinet/in.c,v 1.44.2.14 2002/11/08 00:45:50 suz Exp $
35  * $DragonFly: src/sys/netinet/in.c,v 1.39 2008/06/09 11:24:24 sephe Exp $
36  */
37
38 #include "opt_bootp.h"
39
40 #include <sys/param.h>
41 #include <sys/systm.h>
42 #include <sys/sockio.h>
43 #include <sys/malloc.h>
44 #include <sys/proc.h>
45 #include <sys/msgport.h>
46 #include <sys/socket.h>
47
48 #include <sys/kernel.h>
49 #include <sys/sysctl.h>
50 #include <sys/thread2.h>
51
52 #include <net/if.h>
53 #include <net/if_types.h>
54 #include <net/route.h>
55 #include <net/netmsg2.h>
56
57 #include <netinet/in.h>
58 #include <netinet/in_var.h>
59 #include <netinet/in_pcb.h>
60
61 #include <netinet/igmp_var.h>
62
63 MALLOC_DEFINE(M_IPMADDR, "in_multi", "internet multicast address");
64
65 static int in_mask2len (struct in_addr *);
66 static void in_len2mask (struct in_addr *, int);
67 static int in_lifaddr_ioctl (struct socket *, u_long, caddr_t,
68         struct ifnet *, struct thread *);
69
70 static void     in_socktrim (struct sockaddr_in *);
71 static int      in_ifinit(struct ifnet *, struct in_ifaddr *,
72                     const struct sockaddr_in *, int);
73
74 static void     in_control_dispatch(struct netmsg *);
75 static int      in_control_internal(u_long, caddr_t, struct ifnet *,
76                     struct thread *);
77
78 static int subnetsarelocal = 0;
79 SYSCTL_INT(_net_inet_ip, OID_AUTO, subnets_are_local, CTLFLAG_RW,
80         &subnetsarelocal, 0, "");
81
82 struct in_multihead in_multihead; /* XXX BSS initialization */
83
84 extern struct inpcbinfo ripcbinfo;
85 extern struct inpcbinfo udbinfo;
86
87 /*
88  * Return 1 if an internet address is for a ``local'' host
89  * (one to which we have a connection).  If subnetsarelocal
90  * is true, this includes other subnets of the local net.
91  * Otherwise, it includes only the directly-connected (sub)nets.
92  */
93 int
94 in_localaddr(struct in_addr in)
95 {
96         u_long i = ntohl(in.s_addr);
97         struct in_ifaddr_container *iac;
98         struct in_ifaddr *ia;
99
100         if (subnetsarelocal) {
101                 TAILQ_FOREACH(iac, &in_ifaddrheads[mycpuid], ia_link) {
102                         ia = iac->ia;
103
104                         if ((i & ia->ia_netmask) == ia->ia_net)
105                                 return (1);
106                 }
107         } else {
108                 TAILQ_FOREACH(iac, &in_ifaddrheads[mycpuid], ia_link) {
109                         ia = iac->ia;
110
111                         if ((i & ia->ia_subnetmask) == ia->ia_subnet)
112                                 return (1);
113                 }
114         }
115         return (0);
116 }
117
118 /*
119  * Determine whether an IP address is in a reserved set of addresses
120  * that may not be forwarded, or whether datagrams to that destination
121  * may be forwarded.
122  */
123 int
124 in_canforward(struct in_addr in)
125 {
126         u_long i = ntohl(in.s_addr);
127         u_long net;
128
129         if (IN_EXPERIMENTAL(i) || IN_MULTICAST(i))
130                 return (0);
131         if (IN_CLASSA(i)) {
132                 net = i & IN_CLASSA_NET;
133                 if (net == 0 || net == (IN_LOOPBACKNET << IN_CLASSA_NSHIFT))
134                         return (0);
135         }
136         return (1);
137 }
138
139 /*
140  * Trim a mask in a sockaddr
141  */
142 static void
143 in_socktrim(struct sockaddr_in *ap)
144 {
145     char *cplim = (char *) &ap->sin_addr;
146     char *cp = (char *) (&ap->sin_addr + 1);
147
148     ap->sin_len = 0;
149     while (--cp >= cplim)
150         if (*cp) {
151             (ap)->sin_len = cp - (char *) (ap) + 1;
152             break;
153         }
154 }
155
156 static int
157 in_mask2len(struct in_addr *mask)
158 {
159         int x, y;
160         u_char *p;
161
162         p = (u_char *)mask;
163         for (x = 0; x < sizeof *mask; x++) {
164                 if (p[x] != 0xff)
165                         break;
166         }
167         y = 0;
168         if (x < sizeof *mask) {
169                 for (y = 0; y < 8; y++) {
170                         if ((p[x] & (0x80 >> y)) == 0)
171                                 break;
172                 }
173         }
174         return x * 8 + y;
175 }
176
177 static void
178 in_len2mask(struct in_addr *mask, int len)
179 {
180         int i;
181         u_char *p;
182
183         p = (u_char *)mask;
184         bzero(mask, sizeof *mask);
185         for (i = 0; i < len / 8; i++)
186                 p[i] = 0xff;
187         if (len % 8)
188                 p[i] = (0xff00 >> (len % 8)) & 0xff;
189 }
190
191 static int in_interfaces;       /* number of external internet interfaces */
192
193 struct in_control_arg {
194         u_long          cmd;
195         caddr_t         data;
196         struct ifnet    *ifp;
197         struct thread   *td;
198 };
199
200 static void
201 in_control_dispatch(struct netmsg *nmsg)
202 {
203         struct lwkt_msg *msg = &nmsg->nm_lmsg;
204         const struct in_control_arg *arg = msg->u.ms_resultp;
205         int error;
206
207         error = in_control_internal(arg->cmd, arg->data, arg->ifp, arg->td);
208         lwkt_replymsg(msg, error);
209 }
210
211 /*
212  * Generic internet control operations (ioctl's).
213  * Ifp is 0 if not an interface-specific ioctl.
214  *
215  * NOTE! td might be NULL.
216  */
217 /* ARGSUSED */
218 int
219 in_control(struct socket *so, u_long cmd, caddr_t data, struct ifnet *ifp,
220            struct thread *td)
221 {
222         struct netmsg nmsg;
223         struct in_control_arg arg;
224         struct lwkt_msg *msg;
225         int error;
226
227         switch (cmd) {
228         case SIOCALIFADDR:
229         case SIOCDLIFADDR:
230                 if (td && (error = suser(td)) != 0)
231                         return error;
232                 /* FALLTHROUGH */
233         case SIOCGLIFADDR:
234                 if (!ifp)
235                         return EINVAL;
236                 return in_lifaddr_ioctl(so, cmd, data, ifp, td);
237         }
238
239         KASSERT(cmd != SIOCALIFADDR && cmd != SIOCDLIFADDR,
240                 ("recursive SIOC%cLIFADDR!\n",
241                  cmd == SIOCDLIFADDR ? 'D' : 'A'));
242
243         /*
244          * IFADDR alterations are serialized by netisr0
245          */
246         switch (cmd) {
247         case SIOCSIFDSTADDR:
248         case SIOCSIFBRDADDR:
249         case SIOCSIFADDR:
250         case SIOCSIFNETMASK:
251         case SIOCAIFADDR:
252         case SIOCDIFADDR:
253                 bzero(&arg, sizeof(arg));
254                 arg.cmd = cmd;
255                 arg.data = data;
256                 arg.ifp = ifp;
257                 arg.td = td;
258
259                 netmsg_init(&nmsg, &curthread->td_msgport, 0,
260                             in_control_dispatch);
261                 msg = &nmsg.nm_lmsg;
262                 msg->u.ms_resultp = &arg;
263
264                 lwkt_domsg(cpu_portfn(0), msg, 0);
265                 return msg->ms_error;
266         default:
267                 return in_control_internal(cmd, data, ifp, td);
268         }
269 }
270
271 static void
272 in_ialink_dispatch(struct netmsg *nmsg)
273 {
274         struct lwkt_msg *lmsg = &nmsg->nm_lmsg;
275         struct in_ifaddr *ia = lmsg->u.ms_resultp;
276         struct ifaddr_container *ifac;
277         struct in_ifaddr_container *iac;
278         int cpu = mycpuid;
279
280         crit_enter();
281
282         ifac = &ia->ia_ifa.ifa_containers[cpu];
283         ASSERT_IFAC_VALID(ifac);
284         KASSERT((ifac->ifa_listmask & IFA_LIST_IN_IFADDRHEAD) == 0,
285                 ("ia is on in_ifaddrheads\n"));
286
287         ifac->ifa_listmask |= IFA_LIST_IN_IFADDRHEAD;
288         iac = &ifac->ifa_proto_u.u_in_ifac;
289         TAILQ_INSERT_TAIL(&in_ifaddrheads[cpu], iac, ia_link);
290
291         crit_exit();
292
293         ifa_forwardmsg(lmsg, cpu + 1);
294 }
295
296 static void
297 in_iaunlink_dispatch(struct netmsg *nmsg)
298 {
299         struct lwkt_msg *lmsg = &nmsg->nm_lmsg;
300         struct in_ifaddr *ia = lmsg->u.ms_resultp;
301         struct ifaddr_container *ifac;
302         struct in_ifaddr_container *iac;
303         int cpu = mycpuid;
304
305         crit_enter();
306
307         ifac = &ia->ia_ifa.ifa_containers[cpu];
308         ASSERT_IFAC_VALID(ifac);
309         KASSERT(ifac->ifa_listmask & IFA_LIST_IN_IFADDRHEAD,
310                 ("ia is not on in_ifaddrheads\n"));
311
312         iac = &ifac->ifa_proto_u.u_in_ifac;
313         TAILQ_REMOVE(&in_ifaddrheads[cpu], iac, ia_link);
314         ifac->ifa_listmask &= ~IFA_LIST_IN_IFADDRHEAD;
315
316         crit_exit();
317
318         ifa_forwardmsg(lmsg, cpu + 1);
319 }
320
321 static void
322 in_iahashins_dispatch(struct netmsg *nmsg)
323 {
324         struct lwkt_msg *lmsg = &nmsg->nm_lmsg;
325         struct in_ifaddr *ia = lmsg->u.ms_resultp;
326         struct ifaddr_container *ifac;
327         struct in_ifaddr_container *iac;
328         int cpu = mycpuid;
329
330         crit_enter();
331
332         ifac = &ia->ia_ifa.ifa_containers[cpu];
333         ASSERT_IFAC_VALID(ifac);
334         KASSERT((ifac->ifa_listmask & IFA_LIST_IN_IFADDRHASH) == 0,
335                 ("ia is on in_ifaddrhashtbls\n"));
336
337         ifac->ifa_listmask |= IFA_LIST_IN_IFADDRHASH;
338         iac = &ifac->ifa_proto_u.u_in_ifac;
339         LIST_INSERT_HEAD(INADDR_HASH(ia->ia_addr.sin_addr.s_addr),
340                          iac, ia_hash);
341
342         crit_exit();
343
344         ifa_forwardmsg(lmsg, cpu + 1);
345 }
346
347 static void
348 in_iahashrem_dispatch(struct netmsg *nmsg)
349 {
350         struct lwkt_msg *lmsg = &nmsg->nm_lmsg;
351         struct in_ifaddr *ia = lmsg->u.ms_resultp;
352         struct ifaddr_container *ifac;
353         struct in_ifaddr_container *iac;
354         int cpu = mycpuid;
355
356         crit_enter();
357
358         ifac = &ia->ia_ifa.ifa_containers[cpu];
359         ASSERT_IFAC_VALID(ifac);
360         KASSERT(ifac->ifa_listmask & IFA_LIST_IN_IFADDRHASH,
361                 ("ia is not on in_ifaddrhashtbls\n"));
362
363         iac = &ifac->ifa_proto_u.u_in_ifac;
364         LIST_REMOVE(iac, ia_hash);
365         ifac->ifa_listmask &= ~IFA_LIST_IN_IFADDRHASH;
366
367         crit_exit();
368
369         ifa_forwardmsg(lmsg, cpu + 1);
370 }
371
372 static void
373 in_ialink(struct in_ifaddr *ia)
374 {
375         struct netmsg nmsg;
376         struct lwkt_msg *lmsg;
377
378         netmsg_init(&nmsg, &curthread->td_msgport, 0, in_ialink_dispatch);
379         lmsg = &nmsg.nm_lmsg;
380         lmsg->u.ms_resultp = ia;
381
382         ifa_domsg(lmsg);
383 }
384
385 void
386 in_iaunlink(struct in_ifaddr *ia)
387 {
388         struct netmsg nmsg;
389         struct lwkt_msg *lmsg;
390
391         netmsg_init(&nmsg, &curthread->td_msgport, 0, in_iaunlink_dispatch);
392         lmsg = &nmsg.nm_lmsg;
393         lmsg->u.ms_resultp = ia;
394
395         ifa_domsg(lmsg);
396 }
397
398 void
399 in_iahash_insert(struct in_ifaddr *ia)
400 {
401         struct netmsg nmsg;
402         struct lwkt_msg *lmsg;
403
404         netmsg_init(&nmsg, &curthread->td_msgport, 0, in_iahashins_dispatch);
405         lmsg = &nmsg.nm_lmsg;
406         lmsg->u.ms_resultp = ia;
407
408         ifa_domsg(lmsg);
409 }
410
411 void
412 in_iahash_remove(struct in_ifaddr *ia)
413 {
414         struct netmsg nmsg;
415         struct lwkt_msg *lmsg;
416
417         netmsg_init(&nmsg, &curthread->td_msgport, 0, in_iahashrem_dispatch);
418         lmsg = &nmsg.nm_lmsg;
419         lmsg->u.ms_resultp = ia;
420
421         ifa_domsg(lmsg);
422 }
423
424 static __inline struct in_ifaddr *
425 in_ianext(struct in_ifaddr *oia)
426 {
427         struct ifaddr_container *ifac;
428         struct in_ifaddr_container *iac;
429
430         ifac = &oia->ia_ifa.ifa_containers[mycpuid];
431         ASSERT_IFAC_VALID(ifac);
432         KASSERT(ifac->ifa_listmask & IFA_LIST_IN_IFADDRHEAD,
433                 ("ia is not on in_ifaddrheads\n"));
434
435         iac = &ifac->ifa_proto_u.u_in_ifac;
436         iac = TAILQ_NEXT(iac, ia_link);
437         if (iac != NULL)
438                 return iac->ia;
439         else
440                 return NULL;
441 }
442
443 static int
444 in_control_internal(u_long cmd, caddr_t data, struct ifnet *ifp,
445                     struct thread *td)
446 {
447         struct ifreq *ifr = (struct ifreq *)data;
448         struct in_ifaddr *ia = NULL;
449         struct in_addr dst;
450         struct in_aliasreq *ifra = (struct in_aliasreq *)data;
451         struct ifaddr_container *ifac;
452         struct in_ifaddr_container *iac;
453         struct sockaddr_in oldaddr;
454         int hostIsNew, iaIsNew, maskIsNew;
455         int error = 0;
456
457         iaIsNew = 0;
458
459         /*
460          * Find address for this interface, if it exists.
461          *
462          * If an alias address was specified, find that one instead of
463          * the first one on the interface, if possible
464          */
465         if (ifp) {
466                 struct in_ifaddr *iap;
467
468                 dst = ((struct sockaddr_in *)&ifr->ifr_addr)->sin_addr;
469                 LIST_FOREACH(iac, INADDR_HASH(dst.s_addr), ia_hash) {
470                         iap = iac->ia;
471                         if (iap->ia_ifp == ifp &&
472                             iap->ia_addr.sin_addr.s_addr == dst.s_addr) {
473                                 ia = iap;
474                                 break;
475                         }
476                 }
477                 if (ia == NULL) {
478                         TAILQ_FOREACH(ifac, &ifp->if_addrheads[mycpuid],
479                                       ifa_link) {
480                                 iap = ifatoia(ifac->ifa);
481                                 if (iap->ia_addr.sin_family == AF_INET) {
482                                         ia = iap;
483                                         break;
484                                 }
485                         }
486                 }
487         }
488
489         switch (cmd) {
490         case SIOCAIFADDR:
491         case SIOCDIFADDR:
492                 if (ifp == NULL)
493                         return (EADDRNOTAVAIL);
494                 if (ifra->ifra_addr.sin_family == AF_INET) {
495                         while (ia != NULL) {
496                                 if (ia->ia_ifp == ifp  &&
497                                     ia->ia_addr.sin_addr.s_addr ==
498                                     ifra->ifra_addr.sin_addr.s_addr)
499                                         break;
500                                 ia = in_ianext(ia);
501                         }
502                         if ((ifp->if_flags & IFF_POINTOPOINT) &&
503                             cmd == SIOCAIFADDR &&
504                             ifra->ifra_dstaddr.sin_addr.s_addr == INADDR_ANY) {
505                                 return EDESTADDRREQ;
506                         }
507                 }
508                 if (cmd == SIOCDIFADDR && ia == NULL)
509                         return (EADDRNOTAVAIL);
510                 /* FALLTHROUGH */
511         case SIOCSIFADDR:
512         case SIOCSIFNETMASK:
513         case SIOCSIFDSTADDR:
514                 if (td && (error = suser(td)) != 0)
515                         return error;
516
517                 if (ifp == NULL)
518                         return (EADDRNOTAVAIL);
519
520                 if (cmd == SIOCSIFDSTADDR &&
521                     (ifp->if_flags & IFF_POINTOPOINT) == 0)
522                         return (EINVAL);
523
524                 if (ia == NULL) {
525                         struct ifaddr *ifa;
526                         int i;
527
528                         ia = ifa_create(sizeof(*ia), M_WAITOK);
529                         ifa = &ia->ia_ifa;
530
531                         /*
532                          * Setup per-CPU information
533                          */
534                         for (i = 0; i < ncpus; ++i) {
535                                 ifac = &ifa->ifa_containers[i];
536                                 iac = &ifac->ifa_proto_u.u_in_ifac;
537                                 iac->ia = ia;
538                                 iac->ia_ifac = ifac;
539                         }
540
541                         /*
542                          * Protect from NETISR_IP traversing address list
543                          * while we're modifying it.
544                          */
545                         crit_enter();
546
547                         in_ialink(ia);
548                         ifa_iflink(ifa, ifp, 1);
549
550                         ifa->ifa_addr = (struct sockaddr *)&ia->ia_addr;
551                         ifa->ifa_dstaddr = (struct sockaddr *)&ia->ia_dstaddr;
552                         ifa->ifa_netmask = (struct sockaddr *)&ia->ia_sockmask;
553                         ia->ia_sockmask.sin_len = 8;
554                         ia->ia_sockmask.sin_family = AF_INET;
555                         if (ifp->if_flags & IFF_BROADCAST) {
556                                 ia->ia_broadaddr.sin_len = sizeof ia->ia_addr;
557                                 ia->ia_broadaddr.sin_family = AF_INET;
558                         }
559                         ia->ia_ifp = ifp;
560                         if (!(ifp->if_flags & IFF_LOOPBACK))
561                                 in_interfaces++;
562                         iaIsNew = 1;
563
564                         crit_exit();
565                 }
566                 break;
567
568         case SIOCSIFBRDADDR:
569                 if (td && (error = suser(td)) != 0)
570                         return error;
571                 /* FALLTHROUGH */
572
573         case SIOCGIFADDR:
574         case SIOCGIFNETMASK:
575         case SIOCGIFDSTADDR:
576         case SIOCGIFBRDADDR:
577                 if (ia == NULL)
578                         return (EADDRNOTAVAIL);
579                 break;
580         }
581
582         switch (cmd) {
583         case SIOCGIFADDR:
584                 *((struct sockaddr_in *)&ifr->ifr_addr) = ia->ia_addr;
585                 return (0);
586
587         case SIOCGIFBRDADDR:
588                 if ((ifp->if_flags & IFF_BROADCAST) == 0)
589                         return (EINVAL);
590                 *((struct sockaddr_in *)&ifr->ifr_dstaddr) = ia->ia_broadaddr;
591                 return (0);
592
593         case SIOCGIFDSTADDR:
594                 if ((ifp->if_flags & IFF_POINTOPOINT) == 0)
595                         return (EINVAL);
596                 *((struct sockaddr_in *)&ifr->ifr_dstaddr) = ia->ia_dstaddr;
597                 return (0);
598
599         case SIOCGIFNETMASK:
600                 *((struct sockaddr_in *)&ifr->ifr_addr) = ia->ia_sockmask;
601                 return (0);
602
603         case SIOCSIFDSTADDR:
604                 KKASSERT(ifp->if_flags & IFF_POINTOPOINT);
605
606                 oldaddr = ia->ia_dstaddr;
607                 ia->ia_dstaddr = *(struct sockaddr_in *)&ifr->ifr_dstaddr;
608                 if (ifp->if_ioctl != NULL) {
609                         lwkt_serialize_enter(ifp->if_serializer);
610                         error = ifp->if_ioctl(ifp, SIOCSIFDSTADDR, (caddr_t)ia,
611                                               td->td_proc->p_ucred);
612                         lwkt_serialize_exit(ifp->if_serializer);
613                         if (error) {
614                                 ia->ia_dstaddr = oldaddr;
615                                 return (error);
616                         }
617                 }
618                 if (ia->ia_flags & IFA_ROUTE) {
619                         ia->ia_ifa.ifa_dstaddr = (struct sockaddr *)&oldaddr;
620                         rtinit(&ia->ia_ifa, RTM_DELETE, RTF_HOST);
621                         ia->ia_ifa.ifa_dstaddr =
622                                         (struct sockaddr *)&ia->ia_dstaddr;
623                         rtinit(&ia->ia_ifa, RTM_ADD, RTF_HOST | RTF_UP);
624                 }
625                 return (0);
626
627         case SIOCSIFBRDADDR:
628                 if ((ifp->if_flags & IFF_BROADCAST) == 0)
629                         return (EINVAL);
630                 ia->ia_broadaddr = *(struct sockaddr_in *)&ifr->ifr_broadaddr;
631                 return (0);
632
633         case SIOCSIFADDR:
634                 error = in_ifinit(ifp, ia,
635                     (const struct sockaddr_in *)&ifr->ifr_addr, 1);
636                 if (error != 0 && iaIsNew)
637                         break;
638                 if (error == 0)
639                         EVENTHANDLER_INVOKE(ifaddr_event, ifp);
640                 return (0);
641
642         case SIOCSIFNETMASK:
643                 ia->ia_sockmask.sin_addr = ifra->ifra_addr.sin_addr;
644                 ia->ia_subnetmask = ntohl(ia->ia_sockmask.sin_addr.s_addr);
645                 return (0);
646
647         case SIOCAIFADDR:
648                 maskIsNew = 0;
649                 hostIsNew = 1;
650                 error = 0;
651                 if (ia->ia_addr.sin_family == AF_INET) {
652                         if (ifra->ifra_addr.sin_len == 0) {
653                                 ifra->ifra_addr = ia->ia_addr;
654                                 hostIsNew = 0;
655                         } else if (ifra->ifra_addr.sin_addr.s_addr ==
656                                    ia->ia_addr.sin_addr.s_addr) {
657                                 hostIsNew = 0;
658                         }
659                 }
660                 if (ifra->ifra_mask.sin_len) {
661                         in_ifscrub(ifp, ia);
662                         ia->ia_sockmask = ifra->ifra_mask;
663                         ia->ia_sockmask.sin_family = AF_INET;
664                         ia->ia_subnetmask =
665                             ntohl(ia->ia_sockmask.sin_addr.s_addr);
666                         maskIsNew = 1;
667                 }
668                 if ((ifp->if_flags & IFF_POINTOPOINT) &&
669                     ifra->ifra_dstaddr.sin_family == AF_INET) {
670                         in_ifscrub(ifp, ia);
671                         ia->ia_dstaddr = ifra->ifra_dstaddr;
672                         maskIsNew  = 1; /* We lie; but the effect's the same */
673                 }
674                 if (ifra->ifra_addr.sin_family == AF_INET &&
675                     (hostIsNew || maskIsNew))
676                         error = in_ifinit(ifp, ia, &ifra->ifra_addr, 0);
677
678                 if (error != 0 && iaIsNew)
679                         break;
680
681                 if ((ifp->if_flags & IFF_BROADCAST) &&
682                     ifra->ifra_broadaddr.sin_family == AF_INET)
683                         ia->ia_broadaddr = ifra->ifra_broadaddr;
684                 if (error == 0)
685                         EVENTHANDLER_INVOKE(ifaddr_event, ifp);
686                 return (error);
687
688         case SIOCDIFADDR:
689                 /*
690                  * in_ifscrub kills the interface route.
691                  */
692                 in_ifscrub(ifp, ia);
693                 /*
694                  * in_ifadown gets rid of all the rest of
695                  * the routes.  This is not quite the right
696                  * thing to do, but at least if we are running
697                  * a routing process they will come back.
698                  */
699                 in_ifadown(&ia->ia_ifa, 1);
700                 EVENTHANDLER_INVOKE(ifaddr_event, ifp);
701                 error = 0;
702                 break;
703
704         default:
705                 if (ifp == NULL || ifp->if_ioctl == NULL)
706                         return (EOPNOTSUPP);
707                 lwkt_serialize_enter(ifp->if_serializer);
708                 error = ifp->if_ioctl(ifp, cmd, data, td->td_proc->p_ucred);
709                 lwkt_serialize_exit(ifp->if_serializer);
710                 return (error);
711         }
712
713         ifa_ifunlink(&ia->ia_ifa, ifp);
714         in_iaunlink(ia);
715
716         ifac = &ia->ia_ifa.ifa_containers[mycpuid];
717         if (ifac->ifa_listmask & IFA_LIST_IN_IFADDRHASH)
718                 in_iahash_remove(ia);
719
720         ifa_destroy(&ia->ia_ifa);
721
722         return (error);
723 }
724
725 /*
726  * SIOC[GAD]LIFADDR.
727  *      SIOCGLIFADDR: get first address. (?!?)
728  *      SIOCGLIFADDR with IFLR_PREFIX:
729  *              get first address that matches the specified prefix.
730  *      SIOCALIFADDR: add the specified address.
731  *      SIOCALIFADDR with IFLR_PREFIX:
732  *              EINVAL since we can't deduce hostid part of the address.
733  *      SIOCDLIFADDR: delete the specified address.
734  *      SIOCDLIFADDR with IFLR_PREFIX:
735  *              delete the first address that matches the specified prefix.
736  * return values:
737  *      EINVAL on invalid parameters
738  *      EADDRNOTAVAIL on prefix match failed/specified address not found
739  *      other values may be returned from in_ioctl()
740  *
741  * NOTE! td might be NULL.
742  */
743 static int
744 in_lifaddr_ioctl(struct socket *so, u_long cmd, caddr_t data, struct ifnet *ifp,
745                  struct thread *td)
746 {
747         struct if_laddrreq *iflr = (struct if_laddrreq *)data;
748
749         /* sanity checks */
750         if (!data || !ifp) {
751                 panic("invalid argument to in_lifaddr_ioctl");
752                 /*NOTRECHED*/
753         }
754
755         switch (cmd) {
756         case SIOCGLIFADDR:
757                 /* address must be specified on GET with IFLR_PREFIX */
758                 if ((iflr->flags & IFLR_PREFIX) == 0)
759                         break;
760                 /*FALLTHROUGH*/
761         case SIOCALIFADDR:
762         case SIOCDLIFADDR:
763                 /* address must be specified on ADD and DELETE */
764                 if (iflr->addr.ss_family != AF_INET)
765                         return EINVAL;
766                 if (iflr->addr.ss_len != sizeof(struct sockaddr_in))
767                         return EINVAL;
768                 /* XXX need improvement */
769                 if (iflr->dstaddr.ss_family
770                  && iflr->dstaddr.ss_family != AF_INET)
771                         return EINVAL;
772                 if (iflr->dstaddr.ss_family
773                  && iflr->dstaddr.ss_len != sizeof(struct sockaddr_in))
774                         return EINVAL;
775                 break;
776         default: /*shouldn't happen*/
777                 return EOPNOTSUPP;
778         }
779         if (sizeof(struct in_addr) * 8 < iflr->prefixlen)
780                 return EINVAL;
781
782         switch (cmd) {
783         case SIOCALIFADDR:
784             {
785                 struct in_aliasreq ifra;
786
787                 if (iflr->flags & IFLR_PREFIX)
788                         return EINVAL;
789
790                 /* copy args to in_aliasreq, perform ioctl(SIOCAIFADDR_IN6). */
791                 bzero(&ifra, sizeof ifra);
792                 bcopy(iflr->iflr_name, ifra.ifra_name, sizeof ifra.ifra_name);
793
794                 bcopy(&iflr->addr, &ifra.ifra_addr, iflr->addr.ss_len);
795
796                 if (iflr->dstaddr.ss_family) {  /*XXX*/
797                         bcopy(&iflr->dstaddr, &ifra.ifra_dstaddr,
798                                 iflr->dstaddr.ss_len);
799                 }
800
801                 ifra.ifra_mask.sin_family = AF_INET;
802                 ifra.ifra_mask.sin_len = sizeof(struct sockaddr_in);
803                 in_len2mask(&ifra.ifra_mask.sin_addr, iflr->prefixlen);
804
805                 return in_control(so, SIOCAIFADDR, (caddr_t)&ifra, ifp, td);
806             }
807         case SIOCGLIFADDR:
808         case SIOCDLIFADDR:
809             {
810                 struct ifaddr_container *ifac;
811                 struct in_ifaddr *ia;
812                 struct in_addr mask, candidate, match;
813                 struct sockaddr_in *sin;
814                 int cmp;
815
816                 bzero(&mask, sizeof mask);
817                 if (iflr->flags & IFLR_PREFIX) {
818                         /* lookup a prefix rather than address. */
819                         in_len2mask(&mask, iflr->prefixlen);
820
821                         sin = (struct sockaddr_in *)&iflr->addr;
822                         match.s_addr = sin->sin_addr.s_addr;
823                         match.s_addr &= mask.s_addr;
824
825                         /* if you set extra bits, that's wrong */
826                         if (match.s_addr != sin->sin_addr.s_addr)
827                                 return EINVAL;
828
829                         cmp = 1;
830                 } else {
831                         if (cmd == SIOCGLIFADDR) {
832                                 /* on getting an address, take the 1st match */
833                                 match.s_addr = 0; /* gcc4 warning */
834                                 cmp = 0;        /*XXX*/
835                         } else {
836                                 /* on deleting an address, do exact match */
837                                 in_len2mask(&mask, 32);
838                                 sin = (struct sockaddr_in *)&iflr->addr;
839                                 match.s_addr = sin->sin_addr.s_addr;
840
841                                 cmp = 1;
842                         }
843                 }
844
845                 TAILQ_FOREACH(ifac, &ifp->if_addrheads[mycpuid], ifa_link) {
846                         struct ifaddr *ifa = ifac->ifa;
847
848                         if (ifa->ifa_addr->sa_family != AF_INET6)
849                                 continue;
850                         if (!cmp)
851                                 break;
852                         candidate.s_addr =
853                         ((struct sockaddr_in *)&ifa->ifa_addr)->sin_addr.s_addr;
854                         candidate.s_addr &= mask.s_addr;
855                         if (candidate.s_addr == match.s_addr)
856                                 break;
857                 }
858                 if (ifac == NULL)
859                         return EADDRNOTAVAIL;
860                 ia = (struct in_ifaddr *)(ifac->ifa);
861
862                 if (cmd == SIOCGLIFADDR) {
863                         /* fill in the if_laddrreq structure */
864                         bcopy(&ia->ia_addr, &iflr->addr, ia->ia_addr.sin_len);
865
866                         if ((ifp->if_flags & IFF_POINTOPOINT) != 0) {
867                                 bcopy(&ia->ia_dstaddr, &iflr->dstaddr,
868                                         ia->ia_dstaddr.sin_len);
869                         } else
870                                 bzero(&iflr->dstaddr, sizeof iflr->dstaddr);
871
872                         iflr->prefixlen =
873                                 in_mask2len(&ia->ia_sockmask.sin_addr);
874
875                         iflr->flags = 0;        /*XXX*/
876
877                         return 0;
878                 } else {
879                         struct in_aliasreq ifra;
880
881                         /* fill in_aliasreq and do ioctl(SIOCDIFADDR_IN6) */
882                         bzero(&ifra, sizeof ifra);
883                         bcopy(iflr->iflr_name, ifra.ifra_name,
884                                 sizeof ifra.ifra_name);
885
886                         bcopy(&ia->ia_addr, &ifra.ifra_addr,
887                                 ia->ia_addr.sin_len);
888                         if ((ifp->if_flags & IFF_POINTOPOINT) != 0) {
889                                 bcopy(&ia->ia_dstaddr, &ifra.ifra_dstaddr,
890                                         ia->ia_dstaddr.sin_len);
891                         }
892                         bcopy(&ia->ia_sockmask, &ifra.ifra_dstaddr,
893                                 ia->ia_sockmask.sin_len);
894
895                         return in_control(so, SIOCDIFADDR, (caddr_t)&ifra,
896                                           ifp, td);
897                 }
898             }
899         }
900
901         return EOPNOTSUPP;      /*just for safety*/
902 }
903
904 /*
905  * Delete any existing route for an interface.
906  */
907 void
908 in_ifscrub(struct ifnet *ifp, struct in_ifaddr *ia)
909 {
910
911         if ((ia->ia_flags & IFA_ROUTE) == 0)
912                 return;
913         if (ifp->if_flags & (IFF_LOOPBACK|IFF_POINTOPOINT))
914                 rtinit(&ia->ia_ifa, RTM_DELETE, RTF_HOST);
915         else
916                 rtinit(&ia->ia_ifa, RTM_DELETE, 0);
917         ia->ia_flags &= ~IFA_ROUTE;
918 }
919
920 /*
921  * Initialize an interface's internet address
922  * and routing table entry.
923  */
924 static int
925 in_ifinit(struct ifnet *ifp, struct in_ifaddr *ia,
926           const struct sockaddr_in *sin, int scrub)
927 {
928         u_long i = ntohl(sin->sin_addr.s_addr);
929         struct sockaddr_in oldaddr;
930         struct ifaddr_container *ifac;
931         int flags = RTF_UP, error = 0;
932         int was_hash = 0;
933
934         ifac = &ia->ia_ifa.ifa_containers[mycpuid];
935         oldaddr = ia->ia_addr;
936
937         if (ifac->ifa_listmask & IFA_LIST_IN_IFADDRHASH) {
938                 was_hash = 1;
939                 in_iahash_remove(ia);
940         }
941
942         ia->ia_addr = *sin;
943         if (ia->ia_addr.sin_family == AF_INET)
944                 in_iahash_insert(ia);
945
946         /*
947          * Give the interface a chance to initialize
948          * if this is its first address,
949          * and to validate the address if necessary.
950          */
951         if (ifp->if_ioctl != NULL) {
952                 lwkt_serialize_enter(ifp->if_serializer);
953                 error = ifp->if_ioctl(ifp, SIOCSIFADDR, (caddr_t)ia, NULL);
954                 lwkt_serialize_exit(ifp->if_serializer);
955                 if (error)
956                         goto fail;
957         }
958
959         /*
960          * Delete old route, if requested.
961          */
962         if (scrub) {
963                 ia->ia_ifa.ifa_addr = (struct sockaddr *)&oldaddr;
964                 in_ifscrub(ifp, ia);
965                 ia->ia_ifa.ifa_addr = (struct sockaddr *)&ia->ia_addr;
966         }
967
968         /*
969          * Calculate netmask/subnetmask.
970          */
971         if (IN_CLASSA(i))
972                 ia->ia_netmask = IN_CLASSA_NET;
973         else if (IN_CLASSB(i))
974                 ia->ia_netmask = IN_CLASSB_NET;
975         else
976                 ia->ia_netmask = IN_CLASSC_NET;
977         /*
978          * The subnet mask usually includes at least the standard network part,
979          * but may may be smaller in the case of supernetting.
980          * If it is set, we believe it.
981          */
982         if (ia->ia_subnetmask == 0) {
983                 ia->ia_subnetmask = ia->ia_netmask;
984                 ia->ia_sockmask.sin_addr.s_addr = htonl(ia->ia_subnetmask);
985         } else {
986                 ia->ia_netmask &= ia->ia_subnetmask;
987         }
988         ia->ia_net = i & ia->ia_netmask;
989         ia->ia_subnet = i & ia->ia_subnetmask;
990         in_socktrim(&ia->ia_sockmask);
991
992         /*
993          * Add route for the network.
994          */
995         ia->ia_ifa.ifa_metric = ifp->if_metric;
996         if (ifp->if_flags & IFF_BROADCAST) {
997                 ia->ia_broadaddr.sin_addr.s_addr =
998                         htonl(ia->ia_subnet | ~ia->ia_subnetmask);
999                 ia->ia_netbroadcast.s_addr =
1000                         htonl(ia->ia_net | ~ ia->ia_netmask);
1001         } else if (ifp->if_flags & IFF_LOOPBACK) {
1002                 ia->ia_ifa.ifa_dstaddr = ia->ia_ifa.ifa_addr;
1003                 flags |= RTF_HOST;
1004         } else if (ifp->if_flags & IFF_POINTOPOINT) {
1005                 if (ia->ia_dstaddr.sin_family != AF_INET)
1006                         return (0);
1007                 flags |= RTF_HOST;
1008         }
1009
1010         /*-
1011          * Don't add host routes for interface addresses of
1012          * 0.0.0.0 --> 0.255.255.255 netmask 255.0.0.0.  This makes it
1013          * possible to assign several such address pairs with consistent
1014          * results (no host route) and is required by BOOTP.
1015          *
1016          * XXX: This is ugly !  There should be a way for the caller to
1017          *      say that they don't want a host route.
1018          */
1019         if (ia->ia_addr.sin_addr.s_addr != INADDR_ANY ||
1020             ia->ia_netmask != IN_CLASSA_NET ||
1021             ia->ia_dstaddr.sin_addr.s_addr != htonl(IN_CLASSA_HOST)) {
1022                 if ((error = rtinit(&ia->ia_ifa, RTM_ADD, flags)) != 0)
1023                         goto fail;
1024                 ia->ia_flags |= IFA_ROUTE;
1025         }
1026
1027         /*
1028          * If the interface supports multicast, join the "all hosts"
1029          * multicast group on that interface.
1030          */
1031         if (ifp->if_flags & IFF_MULTICAST) {
1032                 struct in_addr addr;
1033
1034                 addr.s_addr = htonl(INADDR_ALLHOSTS_GROUP);
1035                 in_addmulti(&addr, ifp);
1036         }
1037         return (0);
1038 fail:
1039         if (ifac->ifa_listmask & IFA_LIST_IN_IFADDRHASH)
1040                 in_iahash_remove(ia);
1041
1042         ia->ia_addr = oldaddr;
1043         if (was_hash)
1044                 in_iahash_insert(ia);
1045         return (error);
1046 }
1047
1048
1049 /*
1050  * Return 1 if the address might be a local broadcast address.
1051  */
1052 int
1053 in_broadcast(struct in_addr in, struct ifnet *ifp)
1054 {
1055         struct ifaddr_container *ifac;
1056         u_long t;
1057
1058         if (in.s_addr == INADDR_BROADCAST ||
1059             in.s_addr == INADDR_ANY)
1060                 return 1;
1061         if ((ifp->if_flags & IFF_BROADCAST) == 0)
1062                 return 0;
1063         t = ntohl(in.s_addr);
1064         /*
1065          * Look through the list of addresses for a match
1066          * with a broadcast address.
1067          */
1068 #define ia ((struct in_ifaddr *)ifa)
1069         TAILQ_FOREACH(ifac, &ifp->if_addrheads[mycpuid], ifa_link) {
1070                 struct ifaddr *ifa = ifac->ifa;
1071
1072                 if (ifa->ifa_addr->sa_family == AF_INET &&
1073                     (in.s_addr == ia->ia_broadaddr.sin_addr.s_addr ||
1074                      in.s_addr == ia->ia_netbroadcast.s_addr ||
1075                      /*
1076                       * Check for old-style (host 0) broadcast.
1077                       */
1078                      t == ia->ia_subnet || t == ia->ia_net) &&
1079                      /*
1080                       * Check for an all one subnetmask. These
1081                       * only exist when an interface gets a secondary
1082                       * address.
1083                       */
1084                      ia->ia_subnetmask != (u_long)0xffffffff)
1085                             return 1;
1086         }
1087         return (0);
1088 #undef ia
1089 }
1090 /*
1091  * Add an address to the list of IP multicast addresses for a given interface.
1092  */
1093 struct in_multi *
1094 in_addmulti(struct in_addr *ap, struct ifnet *ifp)
1095 {
1096         struct in_multi *inm;
1097         int error;
1098         struct sockaddr_in sin;
1099         struct ifmultiaddr *ifma;
1100
1101         /*
1102          * Call generic routine to add membership or increment
1103          * refcount.  It wants addresses in the form of a sockaddr,
1104          * so we build one here (being careful to zero the unused bytes).
1105          */
1106         bzero(&sin, sizeof sin);
1107         sin.sin_family = AF_INET;
1108         sin.sin_len = sizeof sin;
1109         sin.sin_addr = *ap;
1110         crit_enter();
1111         error = if_addmulti(ifp, (struct sockaddr *)&sin, &ifma);
1112         if (error) {
1113                 crit_exit();
1114                 return 0;
1115         }
1116
1117         /*
1118          * If ifma->ifma_protospec is null, then if_addmulti() created
1119          * a new record.  Otherwise, we are done.
1120          */
1121         if (ifma->ifma_protospec != 0) {
1122                 crit_exit();
1123                 return ifma->ifma_protospec;
1124         }
1125
1126         /* XXX - if_addmulti uses M_WAITOK.  Can this really be called
1127            at interrupt time?  If so, need to fix if_addmulti. XXX */
1128         inm = kmalloc(sizeof *inm, M_IPMADDR, M_WAITOK | M_ZERO);
1129         inm->inm_addr = *ap;
1130         inm->inm_ifp = ifp;
1131         inm->inm_ifma = ifma;
1132         ifma->ifma_protospec = inm;
1133         LIST_INSERT_HEAD(&in_multihead, inm, inm_link);
1134
1135         /*
1136          * Let IGMP know that we have joined a new IP multicast group.
1137          */
1138         igmp_joingroup(inm);
1139         crit_exit();
1140         return (inm);
1141 }
1142
1143 /*
1144  * Delete a multicast address record.
1145  */
1146 void
1147 in_delmulti(struct in_multi *inm)
1148 {
1149         struct ifmultiaddr *ifma;
1150         struct in_multi my_inm;
1151
1152         crit_enter();
1153         ifma = inm->inm_ifma;
1154         my_inm.inm_ifp = NULL ; /* don't send the leave msg */
1155         if (ifma->ifma_refcount == 1) {
1156                 /*
1157                  * No remaining claims to this record; let IGMP know that
1158                  * we are leaving the multicast group.
1159                  * But do it after the if_delmulti() which might reset
1160                  * the interface and nuke the packet.
1161                  */
1162                 my_inm = *inm ;
1163                 ifma->ifma_protospec = 0;
1164                 LIST_REMOVE(inm, inm_link);
1165                 kfree(inm, M_IPMADDR);
1166         }
1167         /* XXX - should be separate API for when we have an ifma? */
1168         if_delmulti(ifma->ifma_ifp, ifma->ifma_addr);
1169         if (my_inm.inm_ifp != NULL)
1170                 igmp_leavegroup(&my_inm);
1171         crit_exit();
1172 }
1173
1174 void
1175 in_ifdetach(struct ifnet *ifp)
1176 {
1177         in_pcbpurgeif0(LIST_FIRST(&ripcbinfo.pcblisthead), ifp);
1178         in_pcbpurgeif0(LIST_FIRST(&udbinfo.pcblisthead), ifp);
1179 }