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