sys/net/pf/pf_if.c

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