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