1 /* $NetBSD: pf_if.c,v 1.33 2017/03/14 09:03:08 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.33 2017/03/14 09:03:08 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 void pfil_ifnet_wrapper(void *, u_long, void *); 91 void pfil_ifaddr_wrapper(void *, u_long, void *); 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; 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 bound = curlwp_bind(); 126 s = pserialize_read_enter(); 127 IFNET_READER_FOREACH(ifp) { 128 struct psref psref; 129 if_acquire(ifp, &psref); 130 pserialize_read_exit(s); 131 132 pfi_init_groups(ifp); 133 pfi_attach_ifnet(ifp); 134 135 s = pserialize_read_enter(); 136 if_release(ifp, &psref); 137 } 138 pserialize_read_exit(s); 139 curlwp_bindx(bound); 140 141 pfil_add_ihook(pfil_ifnet_wrapper, NULL, PFIL_IFNET, if_pfil); 142 pfil_add_ihook(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; 154 155 pfil_remove_ihook(pfil_ifaddr_wrapper, NULL, PFIL_IFADDR, if_pfil); 156 pfil_remove_ihook(pfil_ifnet_wrapper, NULL, PFIL_IFNET, if_pfil); 157 158 bound = curlwp_bind(); 159 s = pserialize_read_enter(); 160 IFNET_READER_FOREACH(ifp) { 161 struct psref psref; 162 if_acquire(ifp, &psref); 163 pserialize_read_exit(s); 164 165 pfi_detach_ifnet(ifp); 166 pfi_destroy_groups(ifp); 167 168 s = pserialize_read_enter(); 169 if_release(ifp, &psref); 170 } 171 pserialize_read_exit(s); 172 curlwp_bindx(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 int s; 560 561 if (ifp == NULL) 562 return; 563 564 /* Depends on pfi_address_add doesn't sleep */ 565 s = pserialize_read_enter(); 566 IFADDR_READER_FOREACH(ia, ifp) { 567 af = ia->ifa_addr->sa_family; 568 if (af != AF_INET && af != AF_INET6) 569 continue; 570 if ((flags & PFI_AFLAG_BROADCAST) && af == AF_INET6) 571 continue; 572 if ((flags & PFI_AFLAG_BROADCAST) && 573 !(ifp->if_flags & IFF_BROADCAST)) 574 continue; 575 if ((flags & PFI_AFLAG_PEER) && 576 !(ifp->if_flags & IFF_POINTOPOINT)) 577 continue; 578 if ((flags & PFI_AFLAG_NETWORK) && af == AF_INET6 && 579 IN6_IS_ADDR_LINKLOCAL( 580 &((struct sockaddr_in6 *)ia->ifa_addr)->sin6_addr)) 581 continue; 582 if (flags & PFI_AFLAG_NOALIAS) { 583 if (af == AF_INET && got4) 584 continue; 585 if (af == AF_INET6 && got6) 586 continue; 587 } 588 if (af == AF_INET) 589 got4 = 1; 590 else if (af == AF_INET6) 591 got6 = 1; 592 net2 = net; 593 if (net2 == 128 && (flags & PFI_AFLAG_NETWORK)) { 594 if (af == AF_INET) 595 net2 = pfi_unmask(&((struct sockaddr_in *) 596 ia->ifa_netmask)->sin_addr); 597 else if (af == AF_INET6) 598 net2 = pfi_unmask(&((struct sockaddr_in6 *) 599 ia->ifa_netmask)->sin6_addr); 600 } 601 if (af == AF_INET && net2 > 32) 602 net2 = 32; 603 if (flags & PFI_AFLAG_BROADCAST) 604 pfi_address_add(ia->ifa_broadaddr, af, net2); 605 else if (flags & PFI_AFLAG_PEER) 606 pfi_address_add(ia->ifa_dstaddr, af, net2); 607 else 608 pfi_address_add(ia->ifa_addr, af, net2); 609 } 610 pserialize_read_exit(s); 611 } 612 613 void 614 pfi_address_add(struct sockaddr *sa, int af, int net) 615 { 616 struct pfr_addr *p; 617 int i; 618 619 if (pfi_buffer_cnt >= pfi_buffer_max) { 620 int new_max = pfi_buffer_max * 2; 621 622 if (new_max > PFI_BUFFER_MAX) { 623 printf("pfi_address_add: address buffer full (%d/%d)\n", 624 pfi_buffer_cnt, PFI_BUFFER_MAX); 625 return; 626 } 627 p = malloc(new_max * sizeof(*pfi_buffer), PFI_MTYPE, M_NOWAIT); 628 if (p == NULL) { 629 printf("pfi_address_add: no memory to grow buffer " 630 "(%d/%d)\n", pfi_buffer_cnt, PFI_BUFFER_MAX); 631 return; 632 } 633 memcpy(p, pfi_buffer, pfi_buffer_cnt * sizeof(*pfi_buffer)); 634 /* no need to zero buffer */ 635 free(pfi_buffer, PFI_MTYPE); 636 pfi_buffer = p; 637 pfi_buffer_max = new_max; 638 } 639 if (af == AF_INET && net > 32) 640 net = 128; 641 p = pfi_buffer + pfi_buffer_cnt++; 642 bzero(p, sizeof(*p)); 643 p->pfra_af = af; 644 p->pfra_net = net; 645 if (af == AF_INET) 646 p->pfra_ip4addr = ((struct sockaddr_in *)sa)->sin_addr; 647 else if (af == AF_INET6) { 648 p->pfra_ip6addr = ((struct sockaddr_in6 *)sa)->sin6_addr; 649 if (IN6_IS_SCOPE_EMBEDDABLE(&p->pfra_ip6addr)) 650 p->pfra_ip6addr.s6_addr16[1] = 0; 651 } 652 /* mask network address bits */ 653 if (net < 128) 654 ((char *)p)[p->pfra_net/8] &= ~(0xFF >> (p->pfra_net%8)); 655 for (i = (p->pfra_net+7)/8; i < sizeof(p->pfra_u); i++) 656 ((char *)p)[i] = 0; 657 } 658 659 void 660 pfi_dynaddr_remove(struct pf_addr_wrap *aw) 661 { 662 int s; 663 664 if (aw->type != PF_ADDR_DYNIFTL || aw->p.dyn == NULL || 665 aw->p.dyn->pfid_kif == NULL || aw->p.dyn->pfid_kt == NULL) 666 return; 667 668 s = splsoftnet(); 669 TAILQ_REMOVE(&aw->p.dyn->pfid_kif->pfik_dynaddrs, aw->p.dyn, entry); 670 pfi_kif_unref(aw->p.dyn->pfid_kif, PFI_KIF_REF_RULE); 671 aw->p.dyn->pfid_kif = NULL; 672 pfr_detach_table(aw->p.dyn->pfid_kt); 673 aw->p.dyn->pfid_kt = NULL; 674 pool_put(&pfi_addr_pl, aw->p.dyn); 675 aw->p.dyn = NULL; 676 splx(s); 677 } 678 679 void 680 pfi_dynaddr_copyout(struct pf_addr_wrap *aw) 681 { 682 if (aw->type != PF_ADDR_DYNIFTL || aw->p.dyn == NULL || 683 aw->p.dyn->pfid_kif == NULL) 684 return; 685 aw->p.dyncnt = aw->p.dyn->pfid_acnt4 + aw->p.dyn->pfid_acnt6; 686 } 687 688 void 689 pfi_kifaddr_update(void *v) 690 { 691 int s; 692 struct pfi_kif *kif = (struct pfi_kif *)v; 693 694 s = splsoftnet(); 695 pfi_update++; 696 pfi_kif_update(kif); 697 splx(s); 698 } 699 700 int 701 pfi_if_compare(struct pfi_kif *p, struct pfi_kif *q) 702 { 703 return (strncmp(p->pfik_name, q->pfik_name, IFNAMSIZ)); 704 } 705 706 void 707 pfi_fill_oldstatus(struct pf_status *pfs) 708 { 709 struct pfi_kif *p; 710 struct pfi_kif_cmp key; 711 int i, j, k, s; 712 713 strlcpy(key.pfik_name, pfs->ifname, sizeof(key.pfik_name)); 714 s = splsoftnet(); 715 p = RB_FIND(pfi_ifhead, &pfi_ifs, (struct pfi_kif *)&key); 716 if (p == NULL) { 717 splx(s); 718 return; 719 } 720 bzero(pfs->pcounters, sizeof(pfs->pcounters)); 721 bzero(pfs->bcounters, sizeof(pfs->bcounters)); 722 for (i = 0; i < 2; i++) 723 for (j = 0; j < 2; j++) 724 for (k = 0; k < 2; k++) { 725 pfs->pcounters[i][j][k] = 726 p->pfik_packets[i][j][k]; 727 pfs->bcounters[i][j] += 728 p->pfik_bytes[i][j][k]; 729 } 730 splx(s); 731 } 732 733 int 734 pfi_clr_istats(const char *name) 735 { 736 struct pfi_kif *p; 737 int s; 738 739 s = splsoftnet(); 740 RB_FOREACH(p, pfi_ifhead, &pfi_ifs) { 741 if (pfi_skip_if(name, p)) 742 continue; 743 bzero(p->pfik_packets, sizeof(p->pfik_packets)); 744 bzero(p->pfik_bytes, sizeof(p->pfik_bytes)); 745 p->pfik_tzero = time_second; 746 } 747 splx(s); 748 749 return (0); 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 s, n = 0; 757 758 s = splsoftnet(); 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 splx(s); 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 splx(s); 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 int s; 805 806 s = splsoftnet(); 807 RB_FOREACH(p, pfi_ifhead, &pfi_ifs) { 808 if (pfi_skip_if(name, p)) 809 continue; 810 p->pfik_flags |= flags; 811 } 812 splx(s); 813 return (0); 814 } 815 816 int 817 pfi_clear_flags(const char *name, int flags) 818 { 819 struct pfi_kif *p; 820 int s; 821 822 s = splsoftnet(); 823 RB_FOREACH(p, pfi_ifhead, &pfi_ifs) { 824 if (pfi_skip_if(name, p)) 825 continue; 826 p->pfik_flags &= ~flags; 827 } 828 splx(s); 829 return (0); 830 } 831 832 /* from pf_print_state.c */ 833 int 834 pfi_unmask(void *addr) 835 { 836 struct pf_addr *m = addr; 837 int i = 31, j = 0, b = 0; 838 u_int32_t tmp; 839 840 while (j < 4 && m->addr32[j] == 0xffffffff) { 841 b += 32; 842 j++; 843 } 844 if (j < 4) { 845 tmp = ntohl(m->addr32[j]); 846 for (i = 31; tmp & (1 << i); --i) 847 b++; 848 } 849 return (b); 850 } 851 852 #ifdef __NetBSD__ 853 static void 854 pfi_copy_group(char *dest, const char *src, ssize_t sz) 855 { 856 while (sz > 1 && *src && !(*src >= '0' && *src <= '9')) { 857 *dest++ = *src++; 858 sz--; 859 } 860 if (sz > 0) 861 *dest++ = '\0'; 862 } 863 864 void 865 pfi_init_groups(struct ifnet *ifp) 866 { 867 char group[IFNAMSIZ]; 868 869 if_init_groups(ifp); 870 if_addgroup(ifp, IFG_ALL); 871 872 pfi_copy_group(group, ifp->if_xname, sizeof(group)); 873 if_addgroup(ifp, group); 874 } 875 876 void 877 pfi_destroy_groups(struct ifnet *ifp) 878 { 879 char group[IFNAMSIZ]; 880 881 pfi_copy_group(group, ifp->if_xname, sizeof(group)); 882 if_delgroup(ifp, group); 883 884 if_delgroup(ifp, IFG_ALL); 885 if_destroy_groups(ifp); 886 } 887 888 void 889 pfil_ifnet_wrapper(void *arg, u_long cmd, void *arg2) 890 { 891 ifnet_t *ifp = arg2; 892 893 switch (cmd) { 894 case PFIL_IFNET_ATTACH: 895 pfi_init_groups(ifp); 896 897 pfi_attach_ifnet(ifp); 898 break; 899 case PFIL_IFNET_DETACH: 900 pfi_detach_ifnet(ifp); 901 902 pfi_destroy_groups(ifp); 903 break; 904 default: 905 panic("pfil_ifnet_wrapper: unexpected cmd %lu", cmd); 906 } 907 } 908 909 void 910 pfil_ifaddr_wrapper(void *arg, u_long cmd, void *arg2) 911 { 912 struct ifaddr *ifa = arg2; 913 914 switch (cmd) { 915 case SIOCSIFADDR: 916 case SIOCAIFADDR: 917 case SIOCDIFADDR: 918 #ifdef INET6 919 case SIOCAIFADDR_IN6: 920 case SIOCDIFADDR_IN6: 921 #endif /* INET6 */ 922 pfi_kifaddr_update(ifa->ifa_ifp->if_pf_kif); 923 break; 924 default: 925 panic("pfil_ifaddr_wrapper: unexpected ioctl %lu", cmd); 926 } 927 } 928 #endif /* __NetBSD__ */ 929