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