sys/net/pf/pf_if.c

   1 /*      $OpenBSD: pf_if.c,v 1.46 2006/12/13 09:01:59 itojun Exp $ */
   2
   3 /*
   4  * Copyright 2005 Henning Brauer <henning@openbsd.org>
   5  * Copyright 2005 Ryan McBride <mcbride@openbsd.org>
   6  * Copyright (c) 2001 Daniel Hartmeier
   7  * Copyright (c) 2003 Cedric Berger
   8  * All rights reserved.
   9  *
  10  * Redistribution and use in source and binary forms, with or without
  11  * modification, are permitted provided that the following conditions
  12  * are met:
  13  *
  14  *    - Redistributions of source code must retain the above copyright
  15  *      notice, this list of conditions and the following disclaimer.
  16  *    - Redistributions in binary form must reproduce the above
  17  *      copyright notice, this list of conditions and the following
  18  *      disclaimer in the documentation and/or other materials provided
  19  *      with the distribution.
  20  *
  21  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
  22  * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
  23  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
  24  * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
  25  * COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
  26  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
  27  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
  28  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
  29  * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  30  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
  31  * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
  32  * POSSIBILITY OF SUCH DAMAGE.
  33  */
  34
  35 #include "opt_inet.h"
  36 #include "opt_inet6.h"
  37
  38 #include <sys/param.h>
  39 #include <sys/systm.h>
  40 #include <sys/malloc.h>
  41 #include <sys/mbuf.h>
  42 #include <sys/eventhandler.h>
  43 #include <sys/filio.h>
  44 #include <sys/socket.h>
  45 #include <sys/socketvar.h>
  46 #include <sys/kernel.h>
  47 #include <sys/thread2.h>
  48 #include <sys/time.h>
  49 #include <vm/vm_zone.h>
  50
  51 #include <net/if.h>
  52 #include <net/if_types.h>
  53 #include <net/route.h>
  54
  55 #include <netinet/in.h>
  56 #include <netinet/in_var.h>
  57 #include <netinet/in_systm.h>
  58 #include <netinet/ip.h>
  59 #include <netinet/ip_var.h>
  60
  61 #include <net/pf/pfvar.h>
  62
  63 #ifdef INET6
  64 #include <netinet/ip6.h>
  65 #endif /* INET6 */
  66
  67 struct pfi_kif           *pfi_all = NULL;
  68 struct pfi_statehead      pfi_statehead;
  69 vm_zone_t                 pfi_addr_pl;
  70 struct pfi_ifhead         pfi_ifs;
  71 long                      pfi_update = 1;
  72 struct pfr_addr          *pfi_buffer;
  73 int                       pfi_buffer_cnt;
  74 int                       pfi_buffer_max;
  75
  76 eventhandler_tag         pfi_clone_cookie = NULL;
  77 eventhandler_tag         pfi_attach_cookie = NULL;
  78 eventhandler_tag         pfi_detach_cookie = NULL;
  79
  80 void             pfi_kif_update(struct pfi_kif *);
  81 void             pfi_dynaddr_update(struct pfi_dynaddr *dyn);
  82 void             pfi_table_update(struct pfr_ktable *, struct pfi_kif *,
  83                     int, int);
  84 void             pfi_kifaddr_update(void *);
  85 void             pfi_instance_add(struct ifnet *, int, int);
  86 void             pfi_address_add(struct sockaddr *, int, int);
  87 int              pfi_if_compare(struct pfi_kif *, struct pfi_kif *);
  88 int              pfi_skip_if(const char *, struct pfi_kif *);
  89 int              pfi_unmask(void *);
  90 void             pfi_kifaddr_update_event(void *, struct ifnet *,
  91                      enum ifaddr_event, struct ifaddr *);
  92 /*XXX jl void            pfi_attach_clone_event(void *, struct if_clone *);*/
  93 void             pfi_attach_ifnet_event(void *, struct ifnet *);
  94 void             pfi_detach_ifnet_event(void *, struct ifnet *);
  95
  96 RB_PROTOTYPE(pfi_ifhead, pfi_kif, pfik_tree, pfi_if_compare);
  97 RB_GENERATE(pfi_ifhead, pfi_kif, pfik_tree, pfi_if_compare);
  98
  99 #define PFI_BUFFER_MAX          0x10000
 100 MALLOC_DEFINE(PFI_MTYPE, "pf_if", "pf interface table");
 101
 102 void
 103 pfi_initialize(void)
 104 {
 105         struct ifnet    *ifp;
 106
 107         if (pfi_all != NULL)    /* already initialized */
 108                 return;
 109
 110         TAILQ_INIT(&pfi_statehead);
 111         pfi_buffer_max = 64;
 112         pfi_buffer = kmalloc(pfi_buffer_max * sizeof(*pfi_buffer),
 113             PFI_MTYPE, M_WAITOK);
 114
 115         if ((pfi_all = pfi_kif_get(IFG_ALL)) == NULL)
 116                 panic("pfi_kif_get for pfi_all failed");
 117
 118         TAILQ_FOREACH(ifp, &ifnet, if_link) {
 119                 if (ifp->if_dunit != IF_DUNIT_NONE)
 120                         pfi_attach_ifnet(ifp);
 121         }
 122         pfi_attach_cookie = EVENTHANDLER_REGISTER(ifnet_attach_event,
 123             pfi_attach_ifnet_event, NULL, EVENTHANDLER_PRI_ANY);
 124         pfi_detach_cookie = EVENTHANDLER_REGISTER(ifnet_detach_event,
 125             pfi_detach_ifnet_event, NULL, EVENTHANDLER_PRI_ANY);
 126 /* XXX jl       pfi_clone_cookie = EVENTHANDLER_REGISTER(if_clone_event,
 127             pfi_attach_clone_event, NULL, EVENTHANDLER_PRI_ANY); */
 128
 129         if ((pfi_all = pfi_kif_get(IFG_ALL)) == NULL)
 130                 panic("pfi_kif_get for pfi_all failed");
 131 }
 132
 133 void
 134 pfi_cleanup(void)
 135 {
 136         struct pfi_kif *p, key;
 137         struct ifnet *ifp;
 138
 139         EVENTHANDLER_DEREGISTER(ifnet_attach_event, pfi_attach_cookie);
 140         EVENTHANDLER_DEREGISTER(ifnet_detach_event, pfi_detach_cookie);
 141         EVENTHANDLER_DEREGISTER(if_clone_event, pfi_clone_cookie);
 142
 143         /* release PFI_IFLAG_INSTANCE */
 144         TAILQ_FOREACH(ifp, &ifnet, if_link) {
 145                 strlcpy(key.pfik_name, ifp->if_xname, sizeof(key.pfik_name));
 146                 p = RB_FIND(pfi_ifhead, &pfi_ifs, &key);
 147                 if (p != NULL)
 148                         pfi_detach_ifnet(ifp);
 149         }
 150
 151         /* XXX clear all other interface group */
 152         while ((p = RB_MIN(pfi_ifhead, &pfi_ifs))) {
 153                 RB_REMOVE(pfi_ifhead, &pfi_ifs, p);
 154
 155                 kfree(p, PFI_MTYPE);
 156         }
 157         kfree(pfi_buffer, PFI_MTYPE);
 158         pfi_buffer = NULL;
 159         pfi_all = NULL;
 160 }
 161
 162 /*
 163  * Wrapper functions for FreeBSD eventhandler
 164  */
 165 void
 166 pfi_kifaddr_update_event(void *arg, struct ifnet *ifp,
 167     enum ifaddr_event event __unused, struct ifaddr *ifa __unused)
 168 {
 169         struct pfi_kif *p = arg;
 170
 171         /*
 172          * Check to see if it is 'our' interface as we do not have per
 173          * interface hooks and thus get an update for every interface.
 174          */
 175         if (p && p->pfik_ifp == ifp)
 176                 pfi_kifaddr_update(p);
 177 }
 178
 179 /* XXX jl
 180 void
 181 pfi_attach_clone_event(void *arg __unused, struct if_clone *ifc)
 182 {
 183         pfi_attach_clone(ifc);
 184 }
 185 */
 186
 187 void
 188 pfi_attach_ifnet_event(void *arg __unused, struct ifnet *ifp)
 189 {
 190         if (ifp->if_dunit != IF_DUNIT_NONE)
 191                 pfi_attach_ifnet(ifp);
 192 }
 193
 194 void
 195 pfi_detach_ifnet_event(void *arg __unused, struct ifnet *ifp)
 196 {
 197         pfi_detach_ifnet(ifp);
 198 }
 199
 200 struct pfi_kif *
 201 pfi_kif_get(const char *kif_name)
 202 {
 203         struct pfi_kif          *kif;
 204         struct pfi_kif_cmp       s;
 205
 206         bzero(&s, sizeof(s));
 207         strlcpy(s.pfik_ifname, kif_name, sizeof(s.pfik_ifname));
 208         if ((kif = RB_FIND(pfi_ifhead, &pfi_ifs, (struct pfi_kif *)&s)) != NULL)
 209                 return (kif);
 210
 211         /* create new one */
 212         if ((kif = kmalloc(sizeof(*kif), PFI_MTYPE, M_WAITOK)) == NULL)
 213                 return (NULL);
 214
 215         bzero(kif, sizeof(*kif));
 216         strlcpy(kif->pfik_name, kif_name, sizeof(kif->pfik_name));
 217         kif->pfik_tzero = time_second;
 218         TAILQ_INIT(&kif->pfik_dynaddrs);
 219
 220         RB_INSERT(pfi_ifhead, &pfi_ifs, kif);
 221         return (kif);
 222 }
 223
 224 void
 225 pfi_kif_ref(struct pfi_kif *kif, enum pfi_kif_refs what)
 226 {
 227         switch (what) {
 228         case PFI_KIF_REF_RULE:
 229                 kif->pfik_rules++;
 230                 break;
 231         case PFI_KIF_REF_STATE:
 232                 if (!kif->pfik_states++)
 233                         TAILQ_INSERT_TAIL(&pfi_statehead, kif, pfik_w_states);
 234                 break;
 235         default:
 236                 panic("pfi_kif_ref with unknown type");
 237         }
 238 }
 239
 240 void
 241 pfi_kif_unref(struct pfi_kif *kif, enum pfi_kif_refs what)
 242 {
 243         if (kif == NULL)
 244                 return;
 245
 246         switch (what) {
 247         case PFI_KIF_REF_NONE:
 248                 break;
 249         case PFI_KIF_REF_RULE:
 250                 if (kif->pfik_rules <= 0) {
 251                         kprintf("pfi_kif_unref: rules refcount <= 0\n");
 252                         return;
 253                 }
 254                 kif->pfik_rules--;
 255                 break;
 256         case PFI_KIF_REF_STATE:
 257                 if (kif->pfik_states <= 0) {
 258                         kprintf("pfi_kif_unref: state refcount <= 0\n");
 259                         return;
 260                 }
 261                 if (!--kif->pfik_states)
 262                         TAILQ_REMOVE(&pfi_statehead, kif, pfik_w_states);
 263                 break;
 264         default:
 265                 panic("pfi_kif_unref with unknown type");
 266         }
 267
 268         if (kif->pfik_ifp != NULL || kif->pfik_group != NULL || kif == pfi_all)
 269                 return;
 270
 271         if (kif->pfik_rules || kif->pfik_states)
 272                 return;
 273
 274         RB_REMOVE(pfi_ifhead, &pfi_ifs, kif);
 275         kfree(kif, PFI_MTYPE);
 276 }
 277
 278 int
 279 pfi_kif_match(struct pfi_kif *rule_kif, struct pfi_kif *packet_kif)
 280 {
 281         struct ifg_list *p;
 282
 283         if (rule_kif == NULL || rule_kif == packet_kif)
 284                 return (1);
 285
 286         if (rule_kif->pfik_group != NULL)
 287                 TAILQ_FOREACH(p, &packet_kif->pfik_ifp->if_groups, ifgl_next)
 288                         if (p->ifgl_group == rule_kif->pfik_group)
 289                                 return (1);
 290
 291         return (0);
 292 }
 293
 294 void
 295 pfi_attach_ifnet(struct ifnet *ifp)
 296 {
 297         struct pfi_kif          *kif;
 298
 299         pfi_initialize();
 300         crit_enter();
 301         pfi_update++;
 302         if ((kif = pfi_kif_get(ifp->if_xname)) == NULL)
 303                 panic("pfi_kif_get failed");
 304
 305         kif->pfik_ifp = ifp;
 306         ifp->if_pf_kif = (caddr_t)kif;
 307
 308         pfi_kif_update(kif);
 309
 310         crit_exit();
 311 }
 312
 313 void
 314 pfi_detach_ifnet(struct ifnet *ifp)
 315 {
 316         struct pfi_kif          *kif;
 317
 318         if ((kif = (struct pfi_kif *)ifp->if_pf_kif) == NULL)
 319                 return;
 320
 321         crit_enter();
 322         pfi_update++;
 323         pfi_kif_update(kif);
 324
 325         kif->pfik_ifp = NULL;
 326         ifp->if_pf_kif = NULL;
 327         pfi_kif_unref(kif, PFI_KIF_REF_NONE);
 328         crit_exit();
 329 }
 330
 331 void
 332 pfi_attach_ifgroup(struct ifg_group *ifg)
 333 {
 334         struct pfi_kif  *kif;
 335
 336         pfi_initialize();
 337         crit_enter();
 338         pfi_update++;
 339         if ((kif = pfi_kif_get(ifg->ifg_group)) == NULL)
 340                 panic("pfi_kif_get failed");
 341
 342         kif->pfik_group = ifg;
 343         ifg->ifg_pf_kif = (caddr_t)kif;
 344
 345         crit_exit();
 346 }
 347
 348 void
 349 pfi_detach_ifgroup(struct ifg_group *ifg)
 350 {
 351         struct pfi_kif  *kif;
 352
 353         if ((kif = (struct pfi_kif *)ifg->ifg_pf_kif) == NULL)
 354                 return;
 355
 356         crit_enter();
 357         pfi_update++;
 358
 359         kif->pfik_group = NULL;
 360         ifg->ifg_pf_kif = NULL;
 361         pfi_kif_unref(kif, PFI_KIF_REF_NONE);
 362         crit_exit();
 363 }
 364
 365 void
 366 pfi_group_change(const char *group)
 367 {
 368         struct pfi_kif          *kif;
 369
 370         crit_enter();
 371         pfi_update++;
 372         if ((kif = pfi_kif_get(group)) == NULL)
 373                 panic("pfi_kif_get failed");
 374
 375         pfi_kif_update(kif);
 376
 377         crit_exit();
 378 }
 379
 380 int
 381 pfi_match_addr(struct pfi_dynaddr *dyn, struct pf_addr *a, sa_family_t af)
 382 {
 383         switch (af) {
 384 #ifdef INET
 385         case AF_INET:
 386                 switch (dyn->pfid_acnt4) {
 387                 case 0:
 388                         return (0);
 389                 case 1:
 390                         return (PF_MATCHA(0, &dyn->pfid_addr4,
 391                             &dyn->pfid_mask4, a, AF_INET));
 392                 default:
 393                         return (pfr_match_addr(dyn->pfid_kt, a, AF_INET));
 394                 }
 395                 break;
 396 #endif /* INET */
 397 #ifdef INET6
 398         case AF_INET6:
 399                 switch (dyn->pfid_acnt6) {
 400                 case 0:
 401                         return (0);
 402                 case 1:
 403                         return (PF_MATCHA(0, &dyn->pfid_addr6,
 404                             &dyn->pfid_mask6, a, AF_INET6));
 405                 default:
 406                         return (pfr_match_addr(dyn->pfid_kt, a, AF_INET6));
 407                 }
 408                 break;
 409 #endif /* INET6 */
 410         default:
 411                 return (0);
 412         }
 413 }
 414
 415 int
 416 pfi_dynaddr_setup(struct pf_addr_wrap *aw, sa_family_t af)
 417 {
 418         struct pfi_dynaddr      *dyn;
 419         char                     tblname[PF_TABLE_NAME_SIZE];
 420         struct pf_ruleset       *ruleset = NULL;
 421         int                      rv = 0;
 422
 423         if (aw->type != PF_ADDR_DYNIFTL)
 424                 return (0);
 425         if ((dyn = pool_get(&pfi_addr_pl, PR_NOWAIT)) == NULL)
 426                 return (1);
 427         bzero(dyn, sizeof(*dyn));
 428
 429         crit_enter();
 430         if (!strcmp(aw->v.ifname, "self"))
 431                 dyn->pfid_kif = pfi_kif_get(IFG_ALL);
 432         else
 433                 dyn->pfid_kif = pfi_kif_get(aw->v.ifname);
 434         if (dyn->pfid_kif == NULL) {
 435                 rv = 1;
 436                 goto _bad;
 437         }
 438         pfi_kif_ref(dyn->pfid_kif, PFI_KIF_REF_RULE);
 439
 440         dyn->pfid_net = pfi_unmask(&aw->v.a.mask);
 441         if (af == AF_INET && dyn->pfid_net == 32)
 442                 dyn->pfid_net = 128;
 443         strlcpy(tblname, aw->v.ifname, sizeof(tblname));
 444         if (aw->iflags & PFI_AFLAG_NETWORK)
 445                 strlcat(tblname, ":network", sizeof(tblname));
 446         if (aw->iflags & PFI_AFLAG_BROADCAST)
 447                 strlcat(tblname, ":broadcast", sizeof(tblname));
 448         if (aw->iflags & PFI_AFLAG_PEER)
 449                 strlcat(tblname, ":peer", sizeof(tblname));
 450         if (aw->iflags & PFI_AFLAG_NOALIAS)
 451                 strlcat(tblname, ":0", sizeof(tblname));
 452         if (dyn->pfid_net != 128)
 453                 ksnprintf(tblname + strlen(tblname),
 454                     sizeof(tblname) - strlen(tblname), "/%d", dyn->pfid_net);
 455         if ((ruleset = pf_find_or_create_ruleset(PF_RESERVED_ANCHOR)) == NULL) {
 456                 rv = 1;
 457                 goto _bad;
 458         }
 459
 460         if ((dyn->pfid_kt = pfr_attach_table(ruleset, tblname)) == NULL) {
 461                 rv = 1;
 462                 goto _bad;
 463         }
 464
 465         dyn->pfid_kt->pfrkt_flags |= PFR_TFLAG_ACTIVE;
 466         dyn->pfid_iflags = aw->iflags;
 467         dyn->pfid_af = af;
 468
 469         TAILQ_INSERT_TAIL(&dyn->pfid_kif->pfik_dynaddrs, dyn, entry);
 470         aw->p.dyn = dyn;
 471         pfi_kif_update(dyn->pfid_kif);
 472         crit_exit();
 473         return (0);
 474
 475 _bad:
 476         if (dyn->pfid_kt != NULL)
 477                 pfr_detach_table(dyn->pfid_kt);
 478         if (ruleset != NULL)
 479                 pf_remove_if_empty_ruleset(ruleset);
 480         if (dyn->pfid_kif != NULL)
 481                 pfi_kif_unref(dyn->pfid_kif, PFI_KIF_REF_RULE);
 482         pool_put(&pfi_addr_pl, dyn);
 483         crit_exit();
 484         return (rv);
 485 }
 486
 487 void
 488 pfi_kif_update(struct pfi_kif *kif)
 489 {
 490         struct ifg_list         *ifgl;
 491         struct pfi_dynaddr      *p;
 492
 493         /* update all dynaddr */
 494         TAILQ_FOREACH(p, &kif->pfik_dynaddrs, entry)
 495                 pfi_dynaddr_update(p);
 496
 497         /* again for all groups kif is member of */
 498         if (kif->pfik_ifp != NULL)
 499                 TAILQ_FOREACH(ifgl, &kif->pfik_ifp->if_groups, ifgl_next)
 500                         pfi_kif_update((struct pfi_kif *)
 501                             ifgl->ifgl_group->ifg_pf_kif);
 502 }
 503
 504 void
 505 pfi_dynaddr_update(struct pfi_dynaddr *dyn)
 506 {
 507         struct pfi_kif          *kif;
 508         struct pfr_ktable       *kt;
 509
 510         if (dyn == NULL || dyn->pfid_kif == NULL || dyn->pfid_kt == NULL)
 511                 panic("pfi_dynaddr_update");
 512
 513         kif = dyn->pfid_kif;
 514         kt = dyn->pfid_kt;
 515
 516         if (kt->pfrkt_larg != pfi_update) {
 517                 /* this table needs to be brought up-to-date */
 518                 pfi_table_update(kt, kif, dyn->pfid_net, dyn->pfid_iflags);
 519                 kt->pfrkt_larg = pfi_update;
 520         }
 521         pfr_dynaddr_update(kt, dyn);
 522 }
 523
 524 void
 525 pfi_table_update(struct pfr_ktable *kt, struct pfi_kif *kif, int net, int flags)
 526 {
 527         int                      e, size2 = 0;
 528         struct ifg_member       *ifgm;
 529
 530         pfi_buffer_cnt = 0;
 531
 532         if (kif->pfik_ifp != NULL)
 533                 pfi_instance_add(kif->pfik_ifp, net, flags);
 534         else if (kif->pfik_group != NULL)
 535                 TAILQ_FOREACH(ifgm, &kif->pfik_group->ifg_members, ifgm_next)
 536                         pfi_instance_add(ifgm->ifgm_ifp, net, flags);
 537
 538         if ((e = pfr_set_addrs(&kt->pfrkt_t, pfi_buffer, pfi_buffer_cnt, &size2,
 539             NULL, NULL, NULL, 0, PFR_TFLAG_ALLMASK)))
 540                 kprintf("pfi_table_update: cannot set %d new addresses "
 541                     "into table %s: %d\n", pfi_buffer_cnt, kt->pfrkt_name, e);
 542 }
 543
 544 void
 545 pfi_instance_add(struct ifnet *ifp, int net, int flags)
 546 {
 547         struct ifaddr_container *ifac;
 548         int              got4 = 0, got6 = 0;
 549         int              net2, af;
 550
 551         if (ifp == NULL)
 552                 return;
 553         TAILQ_FOREACH(ifac, &ifp->if_addrheads[mycpuid], ifa_link) {
 554                 struct ifaddr *ia = ifac->ifa;
 555
 556                 if (ia->ifa_addr == NULL)
 557                         continue;
 558                 af = ia->ifa_addr->sa_family;
 559                 if (af != AF_INET && af != AF_INET6)
 560                         continue;
 561                 /*
 562                  * XXX: For point-to-point interfaces, (ifname:0) and IPv4,
 563                  *      jump over address without a proper route to work
 564                  *      around a problem with ppp not fully removing the
 565                  *      address used during IPCP.
 566                  */
 567                 if ((ifp->if_flags & IFF_POINTOPOINT) &&
 568                     !(ia->ifa_flags & IFA_ROUTE) &&
 569                     (flags & PFI_AFLAG_NOALIAS) && (af == AF_INET))
 570                         continue;
 571                 if ((flags & PFI_AFLAG_BROADCAST) && af == AF_INET6)
 572                         continue;
 573                 if ((flags & PFI_AFLAG_BROADCAST) &&
 574                     !(ifp->if_flags & IFF_BROADCAST))
 575                         continue;
 576                 if ((flags & PFI_AFLAG_PEER) &&
 577                     !(ifp->if_flags & IFF_POINTOPOINT))
 578                         continue;
 579                 if ((flags & PFI_AFLAG_NETWORK) && af == AF_INET6 &&
 580                     IN6_IS_ADDR_LINKLOCAL(
 581                     &((struct sockaddr_in6 *)ia->ifa_addr)->sin6_addr))
 582                         continue;
 583                 if (flags & PFI_AFLAG_NOALIAS) {
 584                         if (af == AF_INET && got4)
 585                                 continue;
 586                         if (af == AF_INET6 && got6)
 587                                 continue;
 588                 }
 589                 if (af == AF_INET)
 590                         got4 = 1;
 591                 else if (af == AF_INET6)
 592                         got6 = 1;
 593                 net2 = net;
 594                 if (net2 == 128 && (flags & PFI_AFLAG_NETWORK)) {
 595                         if (af == AF_INET)
 596                                 net2 = pfi_unmask(&((struct sockaddr_in *)
 597                                     ia->ifa_netmask)->sin_addr);
 598                         else if (af == AF_INET6)
 599                                 net2 = pfi_unmask(&((struct sockaddr_in6 *)
 600                                     ia->ifa_netmask)->sin6_addr);
 601                 }
 602                 if (af == AF_INET && net2 > 32)
 603                         net2 = 32;
 604                 if (flags & PFI_AFLAG_BROADCAST)
 605                         pfi_address_add(ia->ifa_broadaddr, af, net2);
 606                 else if (flags & PFI_AFLAG_PEER)
 607                         pfi_address_add(ia->ifa_dstaddr, af, net2);
 608                 else
 609                         pfi_address_add(ia->ifa_addr, af, net2);
 610         }
 611 }
 612
 613 void
 614 pfi_address_add(struct sockaddr *sa, int af, int net)
 615 {
 616         struct pfr_addr *p;
 617         int              i;
 618
 619         if (pfi_buffer_cnt >= pfi_buffer_max) {
 620                 int              new_max = pfi_buffer_max * 2;
 621
 622                 if (new_max > PFI_BUFFER_MAX) {
 623                         kprintf("pfi_address_add: address buffer full (%d/%d)\n",
 624                             pfi_buffer_cnt, PFI_BUFFER_MAX);
 625                         return;
 626                 }
 627                 p = kmalloc(new_max * sizeof(*pfi_buffer), PFI_MTYPE, M_WAITOK);
 628                 if (p == NULL) {
 629                         kprintf("pfi_address_add: no memory to grow buffer "
 630                             "(%d/%d)\n", pfi_buffer_cnt, PFI_BUFFER_MAX);
 631                         return;
 632                 }
 633                 memcpy(pfi_buffer, p, pfi_buffer_cnt * sizeof(*pfi_buffer));
 634                 /* no need to zero buffer */
 635                 kfree(pfi_buffer, PFI_MTYPE);
 636                 pfi_buffer = p;
 637                 pfi_buffer_max = new_max;
 638         }
 639         if (af == AF_INET && net > 32)
 640                 net = 128;
 641         p = pfi_buffer + pfi_buffer_cnt++;
 642         bzero(p, sizeof(*p));
 643         p->pfra_af = af;
 644         p->pfra_net = net;
 645         if (af == AF_INET)
 646                 p->pfra_ip4addr = ((struct sockaddr_in *)sa)->sin_addr;
 647         else if (af == AF_INET6) {
 648                 p->pfra_ip6addr = ((struct sockaddr_in6 *)sa)->sin6_addr;
 649                 if (IN6_IS_SCOPE_EMBED(&p->pfra_ip6addr))
 650                         p->pfra_ip6addr.s6_addr16[1] = 0;
 651         }
 652         /* mask network address bits */
 653         if (net < 128)
 654                 ((caddr_t)p)[p->pfra_net/8] &= ~(0xFF >> (p->pfra_net%8));
 655         for (i = (p->pfra_net+7)/8; i < sizeof(p->pfra_u); i++)
 656                 ((caddr_t)p)[i] = 0;
 657 }
 658
 659 void
 660 pfi_dynaddr_remove(struct pf_addr_wrap *aw)
 661 {
 662         if (aw->type != PF_ADDR_DYNIFTL || aw->p.dyn == NULL ||
 663             aw->p.dyn->pfid_kif == NULL || aw->p.dyn->pfid_kt == NULL)
 664                 return;
 665
 666         crit_enter();
 667         TAILQ_REMOVE(&aw->p.dyn->pfid_kif->pfik_dynaddrs, aw->p.dyn, entry);
 668         pfi_kif_unref(aw->p.dyn->pfid_kif, PFI_KIF_REF_RULE);
 669         aw->p.dyn->pfid_kif = NULL;
 670         pfr_detach_table(aw->p.dyn->pfid_kt);
 671         aw->p.dyn->pfid_kt = NULL;
 672         pool_put(&pfi_addr_pl, aw->p.dyn);
 673         aw->p.dyn = NULL;
 674         crit_exit();
 675 }
 676
 677 void
 678 pfi_dynaddr_copyout(struct pf_addr_wrap *aw)
 679 {
 680         if (aw->type != PF_ADDR_DYNIFTL || aw->p.dyn == NULL ||
 681             aw->p.dyn->pfid_kif == NULL)
 682                 return;
 683         aw->p.dyncnt = aw->p.dyn->pfid_acnt4 + aw->p.dyn->pfid_acnt6;
 684 }
 685
 686 void
 687 pfi_kifaddr_update(void *v)
 688 {
 689         struct pfi_kif          *kif = (struct pfi_kif *)v;
 690
 691         crit_enter();
 692         pfi_update++;
 693         pfi_kif_update(kif);
 694         crit_exit();
 695 }
 696
 697 int
 698 pfi_if_compare(struct pfi_kif *p, struct pfi_kif *q)
 699 {
 700         return (strncmp(p->pfik_name, q->pfik_name, IFNAMSIZ));
 701 }
 702
 703 void
 704 pfi_fill_oldstatus(struct pf_status *pfs)
 705 {
 706         struct pfi_kif          *p;
 707         struct pfi_kif_cmp       key;
 708         int                      i, j, k;
 709
 710         strlcpy(key.pfik_ifname, pfs->ifname, sizeof(key.pfik_ifname));
 711         crit_enter();
 712         p = RB_FIND(pfi_ifhead, &pfi_ifs, (struct pfi_kif *)&key);
 713         if (p == NULL) {
 714                 crit_exit();
 715                 return;
 716         }
 717         bzero(pfs->pcounters, sizeof(pfs->pcounters));
 718         bzero(pfs->bcounters, sizeof(pfs->bcounters));
 719         for (i = 0; i < 2; i++)
 720                 for (j = 0; j < 2; j++)
 721                         for (k = 0; k < 2; k++) {
 722                                 pfs->pcounters[i][j][k] =
 723                                         p->pfik_packets[i][j][k];
 724                                 pfs->bcounters[i][j] +=
 725                                         p->pfik_bytes[i][j][k];
 726                         }
 727         crit_exit();
 728 }
 729
 730 int
 731 pfi_clr_istats(const char *name)
 732 {
 733         struct pfi_kif  *p;
 734
 735         crit_enter();
 736         RB_FOREACH(p, pfi_ifhead, &pfi_ifs) {
 737                 if (pfi_skip_if(name, p))
 738                         continue;
 739                 bzero(p->pfik_packets, sizeof(p->pfik_packets));
 740                 bzero(p->pfik_bytes, sizeof(p->pfik_bytes));
 741                 p->pfik_tzero = time_second;
 742         }
 743         crit_exit();
 744
 745         return (0);
 746 }
 747
 748 int
 749 pfi_get_ifaces(const char *name, struct pfi_kif *buf, int *size)
 750 {
 751         struct pfi_kif  *p, *nextp;
 752         int              n = 0;
 753
 754         crit_enter();
 755         for (p = RB_MIN(pfi_ifhead, &pfi_ifs); p; p = nextp) {
 756                 nextp = RB_NEXT(pfi_ifhead, &pfi_ifs, p);
 757                 if (pfi_skip_if(name, p))
 758                         continue;
 759                 if (*size > n++) {
 760                         if (!p->pfik_tzero)
 761                                 p->pfik_tzero = time_second;
 762                         pfi_kif_ref(p, PFI_KIF_REF_RULE);
 763                         if (copyout(p, buf++, sizeof(*buf))) {
 764                                 pfi_kif_unref(p, PFI_KIF_REF_RULE);
 765                                 crit_exit();
 766                                 return (EFAULT);
 767                         }
 768                         nextp = RB_NEXT(pfi_ifhead, &pfi_ifs, p);
 769                         pfi_kif_unref(p, PFI_KIF_REF_RULE);
 770                 }
 771         }
 772         crit_exit();
 773         *size = n;
 774         return (0);
 775 }
 776
 777 int
 778 pfi_skip_if(const char *filter, struct pfi_kif *p)
 779 {
 780         int     n;
 781
 782         if (filter == NULL || !*filter)
 783                 return (0);
 784         if (!strcmp(p->pfik_name, filter))
 785                 return (0);     /* exact match */
 786         n = strlen(filter);
 787         if (n < 1 || n >= IFNAMSIZ)
 788                 return (1);     /* sanity check */
 789         if (filter[n-1] >= '0' && filter[n-1] <= '9')
 790                 return (1);     /* only do exact match in that case */
 791         if (strncmp(p->pfik_name, filter, n))
 792                 return (1);     /* prefix doesn't match */
 793         return (p->pfik_name[n] < '0' || p->pfik_name[n] > '9');
 794 }
 795
 796 int
 797 pfi_set_flags(const char *name, int flags)
 798 {
 799         struct pfi_kif  *p;
 800
 801         crit_enter();
 802         RB_FOREACH(p, pfi_ifhead, &pfi_ifs) {
 803                 if (pfi_skip_if(name, p))
 804                         continue;
 805                 p->pfik_flags |= flags;
 806         }
 807         crit_exit();
 808         return (0);
 809 }
 810
 811 int
 812 pfi_clear_flags(const char *name, int flags)
 813 {
 814         struct pfi_kif  *p;
 815
 816         crit_enter();
 817         RB_FOREACH(p, pfi_ifhead, &pfi_ifs) {
 818                 if (pfi_skip_if(name, p))
 819                         continue;
 820                 p->pfik_flags &= ~flags;
 821         }
 822         crit_exit();
 823         return (0);
 824 }
 825
 826 /* from pf_print_state.c */
 827 int
 828 pfi_unmask(void *addr)
 829 {
 830         struct pf_addr *m = addr;
 831         int i = 31, j = 0, b = 0;
 832         u_int32_t tmp;
 833
 834         while (j < 4 && m->addr32[j] == 0xffffffff) {
 835                 b += 32;
 836                 j++;
 837         }
 838         if (j < 4) {
 839                 tmp = ntohl(m->addr32[j]);
 840                 for (i = 31; tmp & (1 << i); --i)
 841                         b++;
 842         }
 843         return (b);
 844 }
 845