Avoid possible memory leakage.
[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.34 2008/05/24 08:04:42 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 *,
72             struct in_ifaddr *, 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 *ia;
98
99         if (subnetsarelocal) {
100                 TAILQ_FOREACH(ia, &in_ifaddrhead, ia_link)
101                         if ((i & ia->ia_netmask) == ia->ia_net)
102                                 return (1);
103         } else {
104                 TAILQ_FOREACH(ia, &in_ifaddrhead, ia_link)
105                         if ((i & ia->ia_subnetmask) == ia->ia_subnet)
106                                 return (1);
107         }
108         return (0);
109 }
110
111 /*
112  * Determine whether an IP address is in a reserved set of addresses
113  * that may not be forwarded, or whether datagrams to that destination
114  * may be forwarded.
115  */
116 int
117 in_canforward(struct in_addr in)
118 {
119         u_long i = ntohl(in.s_addr);
120         u_long net;
121
122         if (IN_EXPERIMENTAL(i) || IN_MULTICAST(i))
123                 return (0);
124         if (IN_CLASSA(i)) {
125                 net = i & IN_CLASSA_NET;
126                 if (net == 0 || net == (IN_LOOPBACKNET << IN_CLASSA_NSHIFT))
127                         return (0);
128         }
129         return (1);
130 }
131
132 /*
133  * Trim a mask in a sockaddr
134  */
135 static void
136 in_socktrim(struct sockaddr_in *ap)
137 {
138     char *cplim = (char *) &ap->sin_addr;
139     char *cp = (char *) (&ap->sin_addr + 1);
140
141     ap->sin_len = 0;
142     while (--cp >= cplim)
143         if (*cp) {
144             (ap)->sin_len = cp - (char *) (ap) + 1;
145             break;
146         }
147 }
148
149 static int
150 in_mask2len(struct in_addr *mask)
151 {
152         int x, y;
153         u_char *p;
154
155         p = (u_char *)mask;
156         for (x = 0; x < sizeof *mask; x++) {
157                 if (p[x] != 0xff)
158                         break;
159         }
160         y = 0;
161         if (x < sizeof *mask) {
162                 for (y = 0; y < 8; y++) {
163                         if ((p[x] & (0x80 >> y)) == 0)
164                                 break;
165                 }
166         }
167         return x * 8 + y;
168 }
169
170 static void
171 in_len2mask(struct in_addr *mask, int len)
172 {
173         int i;
174         u_char *p;
175
176         p = (u_char *)mask;
177         bzero(mask, sizeof *mask);
178         for (i = 0; i < len / 8; i++)
179                 p[i] = 0xff;
180         if (len % 8)
181                 p[i] = (0xff00 >> (len % 8)) & 0xff;
182 }
183
184 static int in_interfaces;       /* number of external internet interfaces */
185
186 struct in_control_arg {
187         u_long          cmd;
188         caddr_t         data;
189         struct ifnet    *ifp;
190         struct thread   *td;
191 };
192
193 static void
194 in_control_dispatch(struct netmsg *nmsg)
195 {
196         struct lwkt_msg *msg = &nmsg->nm_lmsg;
197         const struct in_control_arg *arg = msg->u.ms_resultp;
198         int error;
199
200         error = in_control_internal(arg->cmd, arg->data, arg->ifp, arg->td);
201         lwkt_replymsg(msg, error);
202 }
203
204 /*
205  * Generic internet control operations (ioctl's).
206  * Ifp is 0 if not an interface-specific ioctl.
207  *
208  * NOTE! td might be NULL.
209  */
210 /* ARGSUSED */
211 int
212 in_control(struct socket *so, u_long cmd, caddr_t data, struct ifnet *ifp,
213            struct thread *td)
214 {
215         struct netmsg nmsg;
216         struct in_control_arg arg;
217         struct lwkt_msg *msg;
218         int error;
219
220         switch (cmd) {
221         case SIOCALIFADDR:
222         case SIOCDLIFADDR:
223                 if (td && (error = suser(td)) != 0)
224                         return error;
225                 /* FALLTHROUGH */
226         case SIOCGLIFADDR:
227                 if (!ifp)
228                         return EINVAL;
229                 return in_lifaddr_ioctl(so, cmd, data, ifp, td);
230         }
231
232         KASSERT(cmd != SIOCALIFADDR && cmd != SIOCDLIFADDR,
233                 ("recursive SIOC%cLIFADDR!\n",
234                  cmd == SIOCDLIFADDR ? 'D' : 'A'));
235
236         /*
237          * IFADDR alterations are serialized by netisr0
238          */
239         switch (cmd) {
240         case SIOCSIFDSTADDR:
241         case SIOCSIFBRDADDR:
242         case SIOCSIFADDR:
243         case SIOCSIFNETMASK:
244         case SIOCAIFADDR:
245         case SIOCDIFADDR:
246                 bzero(&arg, sizeof(arg));
247                 arg.cmd = cmd;
248                 arg.data = data;
249                 arg.ifp = ifp;
250                 arg.td = td;
251
252                 netmsg_init(&nmsg, &curthread->td_msgport, 0,
253                             in_control_dispatch);
254                 msg = &nmsg.nm_lmsg;
255                 msg->u.ms_resultp = &arg;
256
257                 lwkt_domsg(cpu_portfn(0), msg, 0);
258                 return msg->ms_error;
259         default:
260                 return in_control_internal(cmd, data, ifp, td);
261         }
262 }
263
264 static int
265 in_control_internal(u_long cmd, caddr_t data, struct ifnet *ifp,
266                     struct thread *td)
267 {
268         struct ifreq *ifr = (struct ifreq *)data;
269         struct in_ifaddr *ia = 0, *iap;
270         struct in_addr dst;
271         struct in_ifaddr *oia;
272         struct in_aliasreq *ifra = (struct in_aliasreq *)data;
273         struct sockaddr_in oldaddr;
274         int hostIsNew, iaIsNew, maskIsNew;
275         int error = 0;
276
277         iaIsNew = 0;
278
279         /*
280          * Find address for this interface, if it exists.
281          *
282          * If an alias address was specified, find that one instead of
283          * the first one on the interface, if possible
284          */
285         if (ifp) {
286                 dst = ((struct sockaddr_in *)&ifr->ifr_addr)->sin_addr;
287                 LIST_FOREACH(iap, INADDR_HASH(dst.s_addr), ia_hash)
288                         if (iap->ia_ifp == ifp &&
289                             iap->ia_addr.sin_addr.s_addr == dst.s_addr) {
290                                 ia = iap;
291                                 break;
292                         }
293                 if (ia == NULL) {
294                         struct ifaddr_container *ifac;
295
296                         TAILQ_FOREACH(ifac, &ifp->if_addrheads[mycpuid],
297                                       ifa_link) {
298                                 iap = ifatoia(ifac->ifa);
299                                 if (iap->ia_addr.sin_family == AF_INET) {
300                                         ia = iap;
301                                         break;
302                                 }
303                         }
304                 }
305         }
306
307         switch (cmd) {
308         case SIOCAIFADDR:
309         case SIOCDIFADDR:
310                 if (ifp == NULL)
311                         return (EADDRNOTAVAIL);
312                 if (ifra->ifra_addr.sin_family == AF_INET) {
313                         for (oia = ia; ia; ia = TAILQ_NEXT(ia, ia_link)) {
314                                 if (ia->ia_ifp == ifp  &&
315                                     ia->ia_addr.sin_addr.s_addr ==
316                                     ifra->ifra_addr.sin_addr.s_addr)
317                                         break;
318                         }
319                         if ((ifp->if_flags & IFF_POINTOPOINT) &&
320                             cmd == SIOCAIFADDR &&
321                             ifra->ifra_dstaddr.sin_addr.s_addr == INADDR_ANY) {
322                                 return EDESTADDRREQ;
323                         }
324                 }
325                 if (cmd == SIOCDIFADDR && ia == NULL)
326                         return (EADDRNOTAVAIL);
327                 /* FALLTHROUGH */
328         case SIOCSIFADDR:
329         case SIOCSIFNETMASK:
330         case SIOCSIFDSTADDR:
331                 if (td && (error = suser(td)) != 0)
332                         return error;
333
334                 if (ifp == NULL)
335                         return (EADDRNOTAVAIL);
336
337                 if (cmd == SIOCSIFDSTADDR &&
338                     (ifp->if_flags & IFF_POINTOPOINT) == 0)
339                         return (EINVAL);
340
341                 if (ia == NULL) {
342                         struct ifaddr *ifa;
343
344                         ia = ifa_create(sizeof(*ia), M_WAITOK);
345
346                         /*
347                          * Protect from NETISR_IP traversing address list
348                          * while we're modifying it.
349                          */
350                         crit_enter();
351
352                         TAILQ_INSERT_TAIL(&in_ifaddrhead, ia, ia_link);
353                         ifa = &ia->ia_ifa;
354                         ifa_iflink(ifa, ifp, 1);
355
356                         ifa->ifa_addr = (struct sockaddr *)&ia->ia_addr;
357                         ifa->ifa_dstaddr = (struct sockaddr *)&ia->ia_dstaddr;
358                         ifa->ifa_netmask = (struct sockaddr *)&ia->ia_sockmask;
359                         ia->ia_sockmask.sin_len = 8;
360                         ia->ia_sockmask.sin_family = AF_INET;
361                         if (ifp->if_flags & IFF_BROADCAST) {
362                                 ia->ia_broadaddr.sin_len = sizeof ia->ia_addr;
363                                 ia->ia_broadaddr.sin_family = AF_INET;
364                         }
365                         ia->ia_ifp = ifp;
366                         if (!(ifp->if_flags & IFF_LOOPBACK))
367                                 in_interfaces++;
368                         iaIsNew = 1;
369
370                         crit_exit();
371                 }
372                 break;
373
374         case SIOCSIFBRDADDR:
375                 if (td && (error = suser(td)) != 0)
376                         return error;
377                 /* FALLTHROUGH */
378
379         case SIOCGIFADDR:
380         case SIOCGIFNETMASK:
381         case SIOCGIFDSTADDR:
382         case SIOCGIFBRDADDR:
383                 if (ia == NULL)
384                         return (EADDRNOTAVAIL);
385                 break;
386         }
387
388         switch (cmd) {
389         case SIOCGIFADDR:
390                 *((struct sockaddr_in *)&ifr->ifr_addr) = ia->ia_addr;
391                 return (0);
392
393         case SIOCGIFBRDADDR:
394                 if ((ifp->if_flags & IFF_BROADCAST) == 0)
395                         return (EINVAL);
396                 *((struct sockaddr_in *)&ifr->ifr_dstaddr) = ia->ia_broadaddr;
397                 return (0);
398
399         case SIOCGIFDSTADDR:
400                 if ((ifp->if_flags & IFF_POINTOPOINT) == 0)
401                         return (EINVAL);
402                 *((struct sockaddr_in *)&ifr->ifr_dstaddr) = ia->ia_dstaddr;
403                 return (0);
404
405         case SIOCGIFNETMASK:
406                 *((struct sockaddr_in *)&ifr->ifr_addr) = ia->ia_sockmask;
407                 return (0);
408
409         case SIOCSIFDSTADDR:
410                 KKASSERT(ifp->if_flags & IFF_POINTOPOINT);
411
412                 oldaddr = ia->ia_dstaddr;
413                 ia->ia_dstaddr = *(struct sockaddr_in *)&ifr->ifr_dstaddr;
414                 if (ifp->if_ioctl != NULL) {
415                         lwkt_serialize_enter(ifp->if_serializer);
416                         error = ifp->if_ioctl(ifp, SIOCSIFDSTADDR, (caddr_t)ia,
417                                               td->td_proc->p_ucred);
418                         lwkt_serialize_exit(ifp->if_serializer);
419                         if (error) {
420                                 ia->ia_dstaddr = oldaddr;
421                                 return (error);
422                         }
423                 }
424                 if (ia->ia_flags & IFA_ROUTE) {
425                         ia->ia_ifa.ifa_dstaddr = (struct sockaddr *)&oldaddr;
426                         rtinit(&ia->ia_ifa, RTM_DELETE, RTF_HOST);
427                         ia->ia_ifa.ifa_dstaddr =
428                                         (struct sockaddr *)&ia->ia_dstaddr;
429                         rtinit(&ia->ia_ifa, RTM_ADD, RTF_HOST | RTF_UP);
430                 }
431                 return (0);
432
433         case SIOCSIFBRDADDR:
434                 if ((ifp->if_flags & IFF_BROADCAST) == 0)
435                         return (EINVAL);
436                 ia->ia_broadaddr = *(struct sockaddr_in *)&ifr->ifr_broadaddr;
437                 return (0);
438
439         case SIOCSIFADDR:
440                 error = in_ifinit(ifp, ia,
441                     (struct sockaddr_in *) &ifr->ifr_addr, 1);
442                 if (error != 0 && iaIsNew)
443                         break;
444                 if (error == 0)
445                         EVENTHANDLER_INVOKE(ifaddr_event, ifp);
446                 return (0);
447
448         case SIOCSIFNETMASK:
449                 ia->ia_sockmask.sin_addr = ifra->ifra_addr.sin_addr;
450                 ia->ia_subnetmask = ntohl(ia->ia_sockmask.sin_addr.s_addr);
451                 return (0);
452
453         case SIOCAIFADDR:
454                 maskIsNew = 0;
455                 hostIsNew = 1;
456                 error = 0;
457                 if (ia->ia_addr.sin_family == AF_INET) {
458                         if (ifra->ifra_addr.sin_len == 0) {
459                                 ifra->ifra_addr = ia->ia_addr;
460                                 hostIsNew = 0;
461                         } else if (ifra->ifra_addr.sin_addr.s_addr ==
462                                    ia->ia_addr.sin_addr.s_addr) {
463                                 hostIsNew = 0;
464                         }
465                 }
466                 if (ifra->ifra_mask.sin_len) {
467                         in_ifscrub(ifp, ia);
468                         ia->ia_sockmask = ifra->ifra_mask;
469                         ia->ia_sockmask.sin_family = AF_INET;
470                         ia->ia_subnetmask =
471                             ntohl(ia->ia_sockmask.sin_addr.s_addr);
472                         maskIsNew = 1;
473                 }
474                 if ((ifp->if_flags & IFF_POINTOPOINT) &&
475                     ifra->ifra_dstaddr.sin_family == AF_INET) {
476                         in_ifscrub(ifp, ia);
477                         ia->ia_dstaddr = ifra->ifra_dstaddr;
478                         maskIsNew  = 1; /* We lie; but the effect's the same */
479                 }
480                 if (ifra->ifra_addr.sin_family == AF_INET &&
481                     (hostIsNew || maskIsNew))
482                         error = in_ifinit(ifp, ia, &ifra->ifra_addr, 0);
483
484                 if (error != 0 && iaIsNew)
485                         break;
486
487                 if ((ifp->if_flags & IFF_BROADCAST) &&
488                     ifra->ifra_broadaddr.sin_family == AF_INET)
489                         ia->ia_broadaddr = ifra->ifra_broadaddr;
490                 if (error == 0)
491                         EVENTHANDLER_INVOKE(ifaddr_event, ifp);
492                 return (error);
493
494         case SIOCDIFADDR:
495                 /*
496                  * in_ifscrub kills the interface route.
497                  */
498                 in_ifscrub(ifp, ia);
499                 /*
500                  * in_ifadown gets rid of all the rest of
501                  * the routes.  This is not quite the right
502                  * thing to do, but at least if we are running
503                  * a routing process they will come back.
504                  */
505                 in_ifadown(&ia->ia_ifa, 1);
506                 EVENTHANDLER_INVOKE(ifaddr_event, ifp);
507                 error = 0;
508                 break;
509
510         default:
511                 if (ifp == NULL || ifp->if_ioctl == NULL)
512                         return (EOPNOTSUPP);
513                 lwkt_serialize_enter(ifp->if_serializer);
514                 error = ifp->if_ioctl(ifp, cmd, data, td->td_proc->p_ucred);
515                 lwkt_serialize_exit(ifp->if_serializer);
516                 return (error);
517         }
518
519         ifa_ifunlink(&ia->ia_ifa, ifp);
520
521         /*
522          * Protect from NETISR_IP traversing address list while we're modifying
523          * it.
524          */
525         crit_enter();   /* XXX MP */
526         TAILQ_REMOVE(&in_ifaddrhead, ia, ia_link);
527         LIST_REMOVE(ia, ia_hash);
528         crit_exit();    /* XXX MP */
529
530         ifa_destroy(&ia->ia_ifa);
531
532         return (error);
533 }
534
535 /*
536  * SIOC[GAD]LIFADDR.
537  *      SIOCGLIFADDR: get first address. (?!?)
538  *      SIOCGLIFADDR with IFLR_PREFIX:
539  *              get first address that matches the specified prefix.
540  *      SIOCALIFADDR: add the specified address.
541  *      SIOCALIFADDR with IFLR_PREFIX:
542  *              EINVAL since we can't deduce hostid part of the address.
543  *      SIOCDLIFADDR: delete the specified address.
544  *      SIOCDLIFADDR with IFLR_PREFIX:
545  *              delete the first address that matches the specified prefix.
546  * return values:
547  *      EINVAL on invalid parameters
548  *      EADDRNOTAVAIL on prefix match failed/specified address not found
549  *      other values may be returned from in_ioctl()
550  *
551  * NOTE! td might be NULL.
552  */
553 static int
554 in_lifaddr_ioctl(struct socket *so, u_long cmd, caddr_t data, struct ifnet *ifp,
555                  struct thread *td)
556 {
557         struct if_laddrreq *iflr = (struct if_laddrreq *)data;
558
559         /* sanity checks */
560         if (!data || !ifp) {
561                 panic("invalid argument to in_lifaddr_ioctl");
562                 /*NOTRECHED*/
563         }
564
565         switch (cmd) {
566         case SIOCGLIFADDR:
567                 /* address must be specified on GET with IFLR_PREFIX */
568                 if ((iflr->flags & IFLR_PREFIX) == 0)
569                         break;
570                 /*FALLTHROUGH*/
571         case SIOCALIFADDR:
572         case SIOCDLIFADDR:
573                 /* address must be specified on ADD and DELETE */
574                 if (iflr->addr.ss_family != AF_INET)
575                         return EINVAL;
576                 if (iflr->addr.ss_len != sizeof(struct sockaddr_in))
577                         return EINVAL;
578                 /* XXX need improvement */
579                 if (iflr->dstaddr.ss_family
580                  && iflr->dstaddr.ss_family != AF_INET)
581                         return EINVAL;
582                 if (iflr->dstaddr.ss_family
583                  && iflr->dstaddr.ss_len != sizeof(struct sockaddr_in))
584                         return EINVAL;
585                 break;
586         default: /*shouldn't happen*/
587                 return EOPNOTSUPP;
588         }
589         if (sizeof(struct in_addr) * 8 < iflr->prefixlen)
590                 return EINVAL;
591
592         switch (cmd) {
593         case SIOCALIFADDR:
594             {
595                 struct in_aliasreq ifra;
596
597                 if (iflr->flags & IFLR_PREFIX)
598                         return EINVAL;
599
600                 /* copy args to in_aliasreq, perform ioctl(SIOCAIFADDR_IN6). */
601                 bzero(&ifra, sizeof ifra);
602                 bcopy(iflr->iflr_name, ifra.ifra_name, sizeof ifra.ifra_name);
603
604                 bcopy(&iflr->addr, &ifra.ifra_addr, iflr->addr.ss_len);
605
606                 if (iflr->dstaddr.ss_family) {  /*XXX*/
607                         bcopy(&iflr->dstaddr, &ifra.ifra_dstaddr,
608                                 iflr->dstaddr.ss_len);
609                 }
610
611                 ifra.ifra_mask.sin_family = AF_INET;
612                 ifra.ifra_mask.sin_len = sizeof(struct sockaddr_in);
613                 in_len2mask(&ifra.ifra_mask.sin_addr, iflr->prefixlen);
614
615                 return in_control(so, SIOCAIFADDR, (caddr_t)&ifra, ifp, td);
616             }
617         case SIOCGLIFADDR:
618         case SIOCDLIFADDR:
619             {
620                 struct ifaddr_container *ifac;
621                 struct in_ifaddr *ia;
622                 struct in_addr mask, candidate, match;
623                 struct sockaddr_in *sin;
624                 int cmp;
625
626                 bzero(&mask, sizeof mask);
627                 if (iflr->flags & IFLR_PREFIX) {
628                         /* lookup a prefix rather than address. */
629                         in_len2mask(&mask, iflr->prefixlen);
630
631                         sin = (struct sockaddr_in *)&iflr->addr;
632                         match.s_addr = sin->sin_addr.s_addr;
633                         match.s_addr &= mask.s_addr;
634
635                         /* if you set extra bits, that's wrong */
636                         if (match.s_addr != sin->sin_addr.s_addr)
637                                 return EINVAL;
638
639                         cmp = 1;
640                 } else {
641                         if (cmd == SIOCGLIFADDR) {
642                                 /* on getting an address, take the 1st match */
643                                 match.s_addr = 0; /* gcc4 warning */
644                                 cmp = 0;        /*XXX*/
645                         } else {
646                                 /* on deleting an address, do exact match */
647                                 in_len2mask(&mask, 32);
648                                 sin = (struct sockaddr_in *)&iflr->addr;
649                                 match.s_addr = sin->sin_addr.s_addr;
650
651                                 cmp = 1;
652                         }
653                 }
654
655                 TAILQ_FOREACH(ifac, &ifp->if_addrheads[mycpuid], ifa_link) {
656                         struct ifaddr *ifa = ifac->ifa;
657
658                         if (ifa->ifa_addr->sa_family != AF_INET6)
659                                 continue;
660                         if (!cmp)
661                                 break;
662                         candidate.s_addr =
663                         ((struct sockaddr_in *)&ifa->ifa_addr)->sin_addr.s_addr;
664                         candidate.s_addr &= mask.s_addr;
665                         if (candidate.s_addr == match.s_addr)
666                                 break;
667                 }
668                 if (ifac == NULL)
669                         return EADDRNOTAVAIL;
670                 ia = (struct in_ifaddr *)(ifac->ifa);
671
672                 if (cmd == SIOCGLIFADDR) {
673                         /* fill in the if_laddrreq structure */
674                         bcopy(&ia->ia_addr, &iflr->addr, ia->ia_addr.sin_len);
675
676                         if ((ifp->if_flags & IFF_POINTOPOINT) != 0) {
677                                 bcopy(&ia->ia_dstaddr, &iflr->dstaddr,
678                                         ia->ia_dstaddr.sin_len);
679                         } else
680                                 bzero(&iflr->dstaddr, sizeof iflr->dstaddr);
681
682                         iflr->prefixlen =
683                                 in_mask2len(&ia->ia_sockmask.sin_addr);
684
685                         iflr->flags = 0;        /*XXX*/
686
687                         return 0;
688                 } else {
689                         struct in_aliasreq ifra;
690
691                         /* fill in_aliasreq and do ioctl(SIOCDIFADDR_IN6) */
692                         bzero(&ifra, sizeof ifra);
693                         bcopy(iflr->iflr_name, ifra.ifra_name,
694                                 sizeof ifra.ifra_name);
695
696                         bcopy(&ia->ia_addr, &ifra.ifra_addr,
697                                 ia->ia_addr.sin_len);
698                         if ((ifp->if_flags & IFF_POINTOPOINT) != 0) {
699                                 bcopy(&ia->ia_dstaddr, &ifra.ifra_dstaddr,
700                                         ia->ia_dstaddr.sin_len);
701                         }
702                         bcopy(&ia->ia_sockmask, &ifra.ifra_dstaddr,
703                                 ia->ia_sockmask.sin_len);
704
705                         return in_control(so, SIOCDIFADDR, (caddr_t)&ifra,
706                                           ifp, td);
707                 }
708             }
709         }
710
711         return EOPNOTSUPP;      /*just for safety*/
712 }
713
714 /*
715  * Delete any existing route for an interface.
716  */
717 void
718 in_ifscrub(struct ifnet *ifp, struct in_ifaddr *ia)
719 {
720
721         if ((ia->ia_flags & IFA_ROUTE) == 0)
722                 return;
723         if (ifp->if_flags & (IFF_LOOPBACK|IFF_POINTOPOINT))
724                 rtinit(&ia->ia_ifa, RTM_DELETE, RTF_HOST);
725         else
726                 rtinit(&ia->ia_ifa, RTM_DELETE, 0);
727         ia->ia_flags &= ~IFA_ROUTE;
728 }
729
730 /*
731  * Initialize an interface's internet address
732  * and routing table entry.
733  */
734 static int
735 in_ifinit(struct ifnet *ifp, struct in_ifaddr *ia, struct sockaddr_in *sin, int scrub)
736 {
737         u_long i = ntohl(sin->sin_addr.s_addr);
738         struct sockaddr_in oldaddr;
739         int flags = RTF_UP, error = 0;
740
741         crit_enter();
742         oldaddr = ia->ia_addr;
743         if (oldaddr.sin_family == AF_INET)
744                 LIST_REMOVE(ia, ia_hash);
745
746         ia->ia_addr = *sin;
747         if (ia->ia_addr.sin_family == AF_INET) {
748                 LIST_INSERT_HEAD(INADDR_HASH(ia->ia_addr.sin_addr.s_addr),
749                     ia, ia_hash);
750         }
751         crit_exit();
752
753         /*
754          * Give the interface a chance to initialize
755          * if this is its first address,
756          * and to validate the address if necessary.
757          */
758         if (ifp->if_ioctl != NULL) {
759                 lwkt_serialize_enter(ifp->if_serializer);
760                 error = ifp->if_ioctl(ifp, SIOCSIFADDR, (caddr_t)ia, NULL);
761                 lwkt_serialize_exit(ifp->if_serializer);
762                 if (error) {
763                         /* LIST_REMOVE(ia, ia_hash) is done in in_control */
764                         ia->ia_addr = oldaddr;
765                         if (ia->ia_addr.sin_family == AF_INET) {
766                                 crit_enter();
767                                 LIST_INSERT_HEAD(
768                                 INADDR_HASH(ia->ia_addr.sin_addr.s_addr),
769                                 ia, ia_hash);
770                                 crit_exit();
771                         }
772                         return (error);
773                 }
774         }
775
776         /*
777          * Delete old route, if requested.
778          */
779         if (scrub) {
780                 ia->ia_ifa.ifa_addr = (struct sockaddr *)&oldaddr;
781                 in_ifscrub(ifp, ia);
782                 ia->ia_ifa.ifa_addr = (struct sockaddr *)&ia->ia_addr;
783         }
784
785         /*
786          * Calculate netmask/subnetmask.
787          */
788         if (IN_CLASSA(i))
789                 ia->ia_netmask = IN_CLASSA_NET;
790         else if (IN_CLASSB(i))
791                 ia->ia_netmask = IN_CLASSB_NET;
792         else
793                 ia->ia_netmask = IN_CLASSC_NET;
794         /*
795          * The subnet mask usually includes at least the standard network part,
796          * but may may be smaller in the case of supernetting.
797          * If it is set, we believe it.
798          */
799         if (ia->ia_subnetmask == 0) {
800                 ia->ia_subnetmask = ia->ia_netmask;
801                 ia->ia_sockmask.sin_addr.s_addr = htonl(ia->ia_subnetmask);
802         } else {
803                 ia->ia_netmask &= ia->ia_subnetmask;
804         }
805         ia->ia_net = i & ia->ia_netmask;
806         ia->ia_subnet = i & ia->ia_subnetmask;
807         in_socktrim(&ia->ia_sockmask);
808
809         /*
810          * Add route for the network.
811          */
812         ia->ia_ifa.ifa_metric = ifp->if_metric;
813         if (ifp->if_flags & IFF_BROADCAST) {
814                 ia->ia_broadaddr.sin_addr.s_addr =
815                         htonl(ia->ia_subnet | ~ia->ia_subnetmask);
816                 ia->ia_netbroadcast.s_addr =
817                         htonl(ia->ia_net | ~ ia->ia_netmask);
818         } else if (ifp->if_flags & IFF_LOOPBACK) {
819                 ia->ia_ifa.ifa_dstaddr = ia->ia_ifa.ifa_addr;
820                 flags |= RTF_HOST;
821         } else if (ifp->if_flags & IFF_POINTOPOINT) {
822                 if (ia->ia_dstaddr.sin_family != AF_INET)
823                         return (0);
824                 flags |= RTF_HOST;
825         }
826
827         /*-
828          * Don't add host routes for interface addresses of
829          * 0.0.0.0 --> 0.255.255.255 netmask 255.0.0.0.  This makes it
830          * possible to assign several such address pairs with consistent
831          * results (no host route) and is required by BOOTP.
832          *
833          * XXX: This is ugly !  There should be a way for the caller to
834          *      say that they don't want a host route.
835          */
836         if (ia->ia_addr.sin_addr.s_addr != INADDR_ANY ||
837             ia->ia_netmask != IN_CLASSA_NET ||
838             ia->ia_dstaddr.sin_addr.s_addr != htonl(IN_CLASSA_HOST)) {
839                 if ((error = rtinit(&ia->ia_ifa, RTM_ADD, flags)) != 0) {
840                         ia->ia_addr = oldaddr;
841                         return (error);
842                 }
843                 ia->ia_flags |= IFA_ROUTE;
844         }
845
846         /*
847          * If the interface supports multicast, join the "all hosts"
848          * multicast group on that interface.
849          */
850         if (ifp->if_flags & IFF_MULTICAST) {
851                 struct in_addr addr;
852
853                 addr.s_addr = htonl(INADDR_ALLHOSTS_GROUP);
854                 in_addmulti(&addr, ifp);
855         }
856         return (error);
857 }
858
859
860 /*
861  * Return 1 if the address might be a local broadcast address.
862  */
863 int
864 in_broadcast(struct in_addr in, struct ifnet *ifp)
865 {
866         struct ifaddr_container *ifac;
867         u_long t;
868
869         if (in.s_addr == INADDR_BROADCAST ||
870             in.s_addr == INADDR_ANY)
871                 return 1;
872         if ((ifp->if_flags & IFF_BROADCAST) == 0)
873                 return 0;
874         t = ntohl(in.s_addr);
875         /*
876          * Look through the list of addresses for a match
877          * with a broadcast address.
878          */
879 #define ia ((struct in_ifaddr *)ifa)
880         TAILQ_FOREACH(ifac, &ifp->if_addrheads[mycpuid], ifa_link) {
881                 struct ifaddr *ifa = ifac->ifa;
882
883                 if (ifa->ifa_addr->sa_family == AF_INET &&
884                     (in.s_addr == ia->ia_broadaddr.sin_addr.s_addr ||
885                      in.s_addr == ia->ia_netbroadcast.s_addr ||
886                      /*
887                       * Check for old-style (host 0) broadcast.
888                       */
889                      t == ia->ia_subnet || t == ia->ia_net) &&
890                      /*
891                       * Check for an all one subnetmask. These
892                       * only exist when an interface gets a secondary
893                       * address.
894                       */
895                      ia->ia_subnetmask != (u_long)0xffffffff)
896                             return 1;
897         }
898         return (0);
899 #undef ia
900 }
901 /*
902  * Add an address to the list of IP multicast addresses for a given interface.
903  */
904 struct in_multi *
905 in_addmulti(struct in_addr *ap, struct ifnet *ifp)
906 {
907         struct in_multi *inm;
908         int error;
909         struct sockaddr_in sin;
910         struct ifmultiaddr *ifma;
911
912         /*
913          * Call generic routine to add membership or increment
914          * refcount.  It wants addresses in the form of a sockaddr,
915          * so we build one here (being careful to zero the unused bytes).
916          */
917         bzero(&sin, sizeof sin);
918         sin.sin_family = AF_INET;
919         sin.sin_len = sizeof sin;
920         sin.sin_addr = *ap;
921         crit_enter();
922         error = if_addmulti(ifp, (struct sockaddr *)&sin, &ifma);
923         if (error) {
924                 crit_exit();
925                 return 0;
926         }
927
928         /*
929          * If ifma->ifma_protospec is null, then if_addmulti() created
930          * a new record.  Otherwise, we are done.
931          */
932         if (ifma->ifma_protospec != 0) {
933                 crit_exit();
934                 return ifma->ifma_protospec;
935         }
936
937         /* XXX - if_addmulti uses M_WAITOK.  Can this really be called
938            at interrupt time?  If so, need to fix if_addmulti. XXX */
939         inm = kmalloc(sizeof *inm, M_IPMADDR, M_WAITOK | M_ZERO);
940         inm->inm_addr = *ap;
941         inm->inm_ifp = ifp;
942         inm->inm_ifma = ifma;
943         ifma->ifma_protospec = inm;
944         LIST_INSERT_HEAD(&in_multihead, inm, inm_link);
945
946         /*
947          * Let IGMP know that we have joined a new IP multicast group.
948          */
949         igmp_joingroup(inm);
950         crit_exit();
951         return (inm);
952 }
953
954 /*
955  * Delete a multicast address record.
956  */
957 void
958 in_delmulti(struct in_multi *inm)
959 {
960         struct ifmultiaddr *ifma;
961         struct in_multi my_inm;
962
963         crit_enter();
964         ifma = inm->inm_ifma;
965         my_inm.inm_ifp = NULL ; /* don't send the leave msg */
966         if (ifma->ifma_refcount == 1) {
967                 /*
968                  * No remaining claims to this record; let IGMP know that
969                  * we are leaving the multicast group.
970                  * But do it after the if_delmulti() which might reset
971                  * the interface and nuke the packet.
972                  */
973                 my_inm = *inm ;
974                 ifma->ifma_protospec = 0;
975                 LIST_REMOVE(inm, inm_link);
976                 kfree(inm, M_IPMADDR);
977         }
978         /* XXX - should be separate API for when we have an ifma? */
979         if_delmulti(ifma->ifma_ifp, ifma->ifma_addr);
980         if (my_inm.inm_ifp != NULL)
981                 igmp_leavegroup(&my_inm);
982         crit_exit();
983 }
984
985 void
986 in_ifdetach(struct ifnet *ifp)
987 {
988         in_pcbpurgeif0(LIST_FIRST(&ripcbinfo.pcblisthead), ifp);
989         in_pcbpurgeif0(LIST_FIRST(&udbinfo.pcblisthead), ifp);
990 }