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