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