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