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