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