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