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