pf_if.c revision 189106
1/*	$OpenBSD: pf_if.c,v 1.46 2006/12/13 09:01:59 itojun Exp $ */
2
3/*
4 * Copyright 2005 Henning Brauer <henning@openbsd.org>
5 * Copyright 2005 Ryan McBride <mcbride@openbsd.org>
6 * Copyright (c) 2001 Daniel Hartmeier
7 * Copyright (c) 2003 Cedric Berger
8 * All rights reserved.
9 *
10 * Redistribution and use in source and binary forms, with or without
11 * modification, are permitted provided that the following conditions
12 * are met:
13 *
14 *    - Redistributions of source code must retain the above copyright
15 *      notice, this list of conditions and the following disclaimer.
16 *    - Redistributions in binary form must reproduce the above
17 *      copyright notice, this list of conditions and the following
18 *      disclaimer in the documentation and/or other materials provided
19 *      with the distribution.
20 *
21 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
22 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
23 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
24 * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
25 * COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
26 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
27 * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
28 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
29 * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
30 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
31 * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
32 * POSSIBILITY OF SUCH DAMAGE.
33 */
34
35#if defined(__FreeBSD__)
36#include "opt_inet.h"
37#include "opt_inet6.h"
38#include "opt_route.h"
39
40#include <sys/cdefs.h>
41__FBSDID("$FreeBSD: head/sys/contrib/pf/net/pf_if.c 189106 2009-02-27 14:12:05Z bz $");
42#endif
43
44#include <sys/param.h>
45#include <sys/systm.h>
46#ifdef __FreeBSD__
47#include <sys/malloc.h>
48#endif
49#include <sys/mbuf.h>
50#include <sys/filio.h>
51#include <sys/socket.h>
52#include <sys/socketvar.h>
53#include <sys/kernel.h>
54#ifndef __FreeBSD__
55#include <sys/device.h>
56#endif
57#include <sys/time.h>
58#ifdef __FreeBSD__
59#include <sys/vimage.h>
60#endif
61
62#include <net/if.h>
63#include <net/if_types.h>
64#ifdef __FreeBSD__
65#include <net/route.h>
66#include <net/vnet.h>
67#endif
68
69#include <netinet/in.h>
70#include <netinet/in_var.h>
71#include <netinet/in_systm.h>
72#include <netinet/ip.h>
73#include <netinet/ip_var.h>
74
75#include <net/pfvar.h>
76
77#ifdef INET6
78#include <netinet/ip6.h>
79#endif /* INET6 */
80
81struct pfi_kif		 *pfi_all = NULL;
82struct pfi_statehead	  pfi_statehead;
83#ifdef __FreeBSD__
84uma_zone_t		  pfi_addr_pl;
85#else
86struct pool		  pfi_addr_pl;
87#endif
88struct pfi_ifhead	  pfi_ifs;
89long			  pfi_update = 1;
90struct pfr_addr		 *pfi_buffer;
91int			  pfi_buffer_cnt;
92int			  pfi_buffer_max;
93#ifdef __FreeBSD__
94eventhandler_tag	  pfi_attach_cookie = NULL;
95eventhandler_tag	  pfi_detach_cookie = NULL;
96eventhandler_tag	  pfi_attach_group_cookie = NULL;
97eventhandler_tag	  pfi_change_group_cookie = NULL;
98eventhandler_tag	  pfi_detach_group_cookie = NULL;
99eventhandler_tag	  pfi_ifaddr_event_cookie = NULL;
100#endif
101
102void		 pfi_kif_update(struct pfi_kif *);
103void		 pfi_dynaddr_update(struct pfi_dynaddr *dyn);
104void		 pfi_table_update(struct pfr_ktable *, struct pfi_kif *,
105		    int, int);
106void		 pfi_kifaddr_update(void *);
107void		 pfi_instance_add(struct ifnet *, int, int);
108void		 pfi_address_add(struct sockaddr *, int, int);
109int		 pfi_if_compare(struct pfi_kif *, struct pfi_kif *);
110int		 pfi_skip_if(const char *, struct pfi_kif *);
111int		 pfi_unmask(void *);
112#ifdef __FreeBSD__
113void		 pfi_attach_ifnet_event(void * __unused, struct ifnet *);
114void		 pfi_detach_ifnet_event(void * __unused, struct ifnet *);
115void		 pfi_attach_group_event(void * __unused, struct ifg_group *);
116void		 pfi_change_group_event(void * __unused, char *);
117void		 pfi_detach_group_event(void * __unused, struct ifg_group *);
118void		 pfi_ifaddr_event(void * __unused, struct ifnet *);
119
120#ifdef VIMAGE_GLOBALS
121extern struct ifgrouphead ifg_head;
122#endif
123#endif
124
125RB_PROTOTYPE(pfi_ifhead, pfi_kif, pfik_tree, pfi_if_compare);
126RB_GENERATE(pfi_ifhead, pfi_kif, pfik_tree, pfi_if_compare);
127
128#define PFI_BUFFER_MAX		0x10000
129#define PFI_MTYPE		M_IFADDR
130
131void
132pfi_initialize(void)
133{
134	INIT_VNET_NET(curvnet);
135
136	if (pfi_all != NULL)	/* already initialized */
137		return;
138
139	TAILQ_INIT(&pfi_statehead);
140#ifndef __FreeBSD__
141	pool_init(&pfi_addr_pl, sizeof(struct pfi_dynaddr), 0, 0, 0,
142	    "pfiaddrpl", &pool_allocator_nointr);
143#endif
144	pfi_buffer_max = 64;
145	pfi_buffer = malloc(pfi_buffer_max * sizeof(*pfi_buffer),
146	    PFI_MTYPE, M_WAITOK);
147
148	if ((pfi_all = pfi_kif_get(IFG_ALL)) == NULL)
149		panic("pfi_kif_get for pfi_all failed");
150
151#ifdef __FreeBSD__
152	struct ifg_group *ifg;
153	struct ifnet *ifp;
154
155	IFNET_RLOCK();
156	TAILQ_FOREACH(ifg, &V_ifg_head, ifg_next)
157		pfi_attach_ifgroup(ifg);
158	TAILQ_FOREACH(ifp, &V_ifnet, if_link)
159		pfi_attach_ifnet(ifp);
160	IFNET_RUNLOCK();
161
162	pfi_attach_cookie = EVENTHANDLER_REGISTER(ifnet_arrival_event,
163	    pfi_attach_ifnet_event, NULL, EVENTHANDLER_PRI_ANY);
164	pfi_detach_cookie = EVENTHANDLER_REGISTER(ifnet_departure_event,
165	    pfi_detach_ifnet_event, NULL, EVENTHANDLER_PRI_ANY);
166	pfi_attach_group_cookie = EVENTHANDLER_REGISTER(group_attach_event,
167	    pfi_attach_group_event, NULL, EVENTHANDLER_PRI_ANY);
168	pfi_change_group_cookie = EVENTHANDLER_REGISTER(group_change_event,
169	    pfi_change_group_event, NULL, EVENTHANDLER_PRI_ANY);
170	pfi_detach_group_cookie = EVENTHANDLER_REGISTER(group_detach_event,
171	    pfi_detach_group_event, NULL, EVENTHANDLER_PRI_ANY);
172	pfi_ifaddr_event_cookie = EVENTHANDLER_REGISTER(ifaddr_event,
173	    pfi_ifaddr_event, NULL, EVENTHANDLER_PRI_ANY);
174#endif
175}
176
177#ifdef __FreeBSD__
178void
179pfi_cleanup(void)
180{
181	struct pfi_kif *p;
182
183	PF_UNLOCK();
184	EVENTHANDLER_DEREGISTER(ifnet_arrival_event, pfi_attach_cookie);
185	EVENTHANDLER_DEREGISTER(ifnet_departure_event, pfi_detach_cookie);
186	EVENTHANDLER_DEREGISTER(group_attach_event, pfi_attach_group_cookie);
187	EVENTHANDLER_DEREGISTER(group_change_event, pfi_change_group_cookie);
188	EVENTHANDLER_DEREGISTER(group_detach_event, pfi_detach_group_cookie);
189	EVENTHANDLER_DEREGISTER(ifaddr_event, pfi_ifaddr_event_cookie);
190	PF_LOCK();
191
192	pfi_all = NULL;
193	while ((p = RB_MIN(pfi_ifhead, &pfi_ifs))) {
194		if (p->pfik_rules || p->pfik_states) {
195			printf("pfi_cleanup: dangling refs for %s\n",
196			    p->pfik_name);
197		}
198
199		RB_REMOVE(pfi_ifhead, &pfi_ifs, p);
200		free(p, PFI_MTYPE);
201	}
202
203	free(pfi_buffer, PFI_MTYPE);
204}
205#endif
206
207struct pfi_kif *
208pfi_kif_get(const char *kif_name)
209{
210	struct pfi_kif		*kif;
211	struct pfi_kif_cmp	 s;
212
213	bzero(&s, sizeof(s));
214	strlcpy(s.pfik_name, kif_name, sizeof(s.pfik_name));
215	if ((kif = RB_FIND(pfi_ifhead, &pfi_ifs, (struct pfi_kif *)&s)) != NULL)
216		return (kif);
217
218	/* create new one */
219#ifdef __FreeBSD__
220	if ((kif = malloc(sizeof(*kif), PFI_MTYPE, M_NOWAIT)) == NULL)
221#else
222	if ((kif = malloc(sizeof(*kif), PFI_MTYPE, M_DONTWAIT)) == NULL)
223#endif
224		return (NULL);
225
226	bzero(kif, sizeof(*kif));
227	strlcpy(kif->pfik_name, kif_name, sizeof(kif->pfik_name));
228#ifdef __FreeBSD__
229	/*
230	 * It seems that the value of time_second is in unintialzied state
231	 * when pf sets interface statistics clear time in boot phase if pf
232	 * was statically linked to kernel. Instead of setting the bogus
233	 * time value have pfi_get_ifaces handle this case. In
234	 * pfi_get_ifaces it uses boottime.tv_sec if it sees the time is 0.
235	 */
236	kif->pfik_tzero = time_second > 1 ? time_second : 0;
237#else
238	kif->pfik_tzero = time_second;
239#endif
240	TAILQ_INIT(&kif->pfik_dynaddrs);
241
242	RB_INSERT(pfi_ifhead, &pfi_ifs, kif);
243	return (kif);
244}
245
246void
247pfi_kif_ref(struct pfi_kif *kif, enum pfi_kif_refs what)
248{
249	switch (what) {
250	case PFI_KIF_REF_RULE:
251		kif->pfik_rules++;
252		break;
253	case PFI_KIF_REF_STATE:
254		if (!kif->pfik_states++)
255			TAILQ_INSERT_TAIL(&pfi_statehead, kif, pfik_w_states);
256		break;
257	default:
258		panic("pfi_kif_ref with unknown type");
259	}
260}
261
262void
263pfi_kif_unref(struct pfi_kif *kif, enum pfi_kif_refs what)
264{
265	if (kif == NULL)
266		return;
267
268	switch (what) {
269	case PFI_KIF_REF_NONE:
270		break;
271	case PFI_KIF_REF_RULE:
272		if (kif->pfik_rules <= 0) {
273			printf("pfi_kif_unref: rules refcount <= 0\n");
274			return;
275		}
276		kif->pfik_rules--;
277		break;
278	case PFI_KIF_REF_STATE:
279		if (kif->pfik_states <= 0) {
280			printf("pfi_kif_unref: state refcount <= 0\n");
281			return;
282		}
283		if (!--kif->pfik_states)
284			TAILQ_REMOVE(&pfi_statehead, kif, pfik_w_states);
285		break;
286	default:
287		panic("pfi_kif_unref with unknown type");
288	}
289
290	if (kif->pfik_ifp != NULL || kif->pfik_group != NULL || kif == pfi_all)
291		return;
292
293	if (kif->pfik_rules || kif->pfik_states)
294		return;
295
296	RB_REMOVE(pfi_ifhead, &pfi_ifs, kif);
297	free(kif, PFI_MTYPE);
298}
299
300int
301pfi_kif_match(struct pfi_kif *rule_kif, struct pfi_kif *packet_kif)
302{
303	struct ifg_list	*p;
304
305	if (rule_kif == NULL || rule_kif == packet_kif)
306		return (1);
307
308	if (rule_kif->pfik_group != NULL)
309		TAILQ_FOREACH(p, &packet_kif->pfik_ifp->if_groups, ifgl_next)
310			if (p->ifgl_group == rule_kif->pfik_group)
311				return (1);
312
313	return (0);
314}
315
316void
317pfi_attach_ifnet(struct ifnet *ifp)
318{
319	struct pfi_kif		*kif;
320	int			 s;
321
322	pfi_initialize();
323	s = splsoftnet();
324	pfi_update++;
325	if ((kif = pfi_kif_get(ifp->if_xname)) == NULL)
326		panic("pfi_kif_get failed");
327
328	kif->pfik_ifp = ifp;
329	ifp->if_pf_kif = (caddr_t)kif;
330
331#ifndef __FreeBSD__
332	if ((kif->pfik_ah_cookie = hook_establish(ifp->if_addrhooks, 1,
333	    pfi_kifaddr_update, kif)) == NULL)
334		panic("pfi_attach_ifnet: cannot allocate '%s' address hook",
335		    ifp->if_xname);
336#endif
337
338	pfi_kif_update(kif);
339
340	splx(s);
341}
342
343void
344pfi_detach_ifnet(struct ifnet *ifp)
345{
346	int			 s;
347	struct pfi_kif		*kif;
348
349	if ((kif = (struct pfi_kif *)ifp->if_pf_kif) == NULL)
350		return;
351
352	s = splsoftnet();
353	pfi_update++;
354#ifndef __FreeBSD__
355	hook_disestablish(ifp->if_addrhooks, kif->pfik_ah_cookie);
356#endif
357	pfi_kif_update(kif);
358
359	kif->pfik_ifp = NULL;
360	ifp->if_pf_kif = NULL;
361	pfi_kif_unref(kif, PFI_KIF_REF_NONE);
362	splx(s);
363}
364
365void
366pfi_attach_ifgroup(struct ifg_group *ifg)
367{
368	struct pfi_kif	*kif;
369	int		 s;
370
371	pfi_initialize();
372	s = splsoftnet();
373	pfi_update++;
374	if ((kif = pfi_kif_get(ifg->ifg_group)) == NULL)
375		panic("pfi_kif_get failed");
376
377	kif->pfik_group = ifg;
378	ifg->ifg_pf_kif = (caddr_t)kif;
379
380	splx(s);
381}
382
383void
384pfi_detach_ifgroup(struct ifg_group *ifg)
385{
386	int		 s;
387	struct pfi_kif	*kif;
388
389	if ((kif = (struct pfi_kif *)ifg->ifg_pf_kif) == NULL)
390		return;
391
392	s = splsoftnet();
393	pfi_update++;
394
395	kif->pfik_group = NULL;
396	ifg->ifg_pf_kif = NULL;
397	pfi_kif_unref(kif, PFI_KIF_REF_NONE);
398	splx(s);
399}
400
401void
402pfi_group_change(const char *group)
403{
404	struct pfi_kif		*kif;
405	int			 s;
406
407	s = splsoftnet();
408	pfi_update++;
409	if ((kif = pfi_kif_get(group)) == NULL)
410		panic("pfi_kif_get failed");
411
412	pfi_kif_update(kif);
413
414	splx(s);
415}
416
417int
418pfi_match_addr(struct pfi_dynaddr *dyn, struct pf_addr *a, sa_family_t af)
419{
420	switch (af) {
421#ifdef INET
422	case AF_INET:
423		switch (dyn->pfid_acnt4) {
424		case 0:
425			return (0);
426		case 1:
427			return (PF_MATCHA(0, &dyn->pfid_addr4,
428			    &dyn->pfid_mask4, a, AF_INET));
429		default:
430			return (pfr_match_addr(dyn->pfid_kt, a, AF_INET));
431		}
432		break;
433#endif /* INET */
434#ifdef INET6
435	case AF_INET6:
436		switch (dyn->pfid_acnt6) {
437		case 0:
438			return (0);
439		case 1:
440			return (PF_MATCHA(0, &dyn->pfid_addr6,
441			    &dyn->pfid_mask6, a, AF_INET6));
442		default:
443			return (pfr_match_addr(dyn->pfid_kt, a, AF_INET6));
444		}
445		break;
446#endif /* INET6 */
447	default:
448		return (0);
449	}
450}
451
452int
453pfi_dynaddr_setup(struct pf_addr_wrap *aw, sa_family_t af)
454{
455	struct pfi_dynaddr	*dyn;
456	char			 tblname[PF_TABLE_NAME_SIZE];
457	struct pf_ruleset	*ruleset = NULL;
458	int			 s, rv = 0;
459
460	if (aw->type != PF_ADDR_DYNIFTL)
461		return (0);
462	if ((dyn = pool_get(&pfi_addr_pl, PR_NOWAIT)) == NULL)
463		return (1);
464	bzero(dyn, sizeof(*dyn));
465
466	s = splsoftnet();
467	if (!strcmp(aw->v.ifname, "self"))
468		dyn->pfid_kif = pfi_kif_get(IFG_ALL);
469	else
470		dyn->pfid_kif = pfi_kif_get(aw->v.ifname);
471	if (dyn->pfid_kif == NULL) {
472		rv = 1;
473		goto _bad;
474	}
475	pfi_kif_ref(dyn->pfid_kif, PFI_KIF_REF_RULE);
476
477	dyn->pfid_net = pfi_unmask(&aw->v.a.mask);
478	if (af == AF_INET && dyn->pfid_net == 32)
479		dyn->pfid_net = 128;
480	strlcpy(tblname, aw->v.ifname, sizeof(tblname));
481	if (aw->iflags & PFI_AFLAG_NETWORK)
482		strlcat(tblname, ":network", sizeof(tblname));
483	if (aw->iflags & PFI_AFLAG_BROADCAST)
484		strlcat(tblname, ":broadcast", sizeof(tblname));
485	if (aw->iflags & PFI_AFLAG_PEER)
486		strlcat(tblname, ":peer", sizeof(tblname));
487	if (aw->iflags & PFI_AFLAG_NOALIAS)
488		strlcat(tblname, ":0", sizeof(tblname));
489	if (dyn->pfid_net != 128)
490		snprintf(tblname + strlen(tblname),
491		    sizeof(tblname) - strlen(tblname), "/%d", dyn->pfid_net);
492	if ((ruleset = pf_find_or_create_ruleset(PF_RESERVED_ANCHOR)) == NULL) {
493		rv = 1;
494		goto _bad;
495	}
496
497	if ((dyn->pfid_kt = pfr_attach_table(ruleset, tblname)) == NULL) {
498		rv = 1;
499		goto _bad;
500	}
501
502	dyn->pfid_kt->pfrkt_flags |= PFR_TFLAG_ACTIVE;
503	dyn->pfid_iflags = aw->iflags;
504	dyn->pfid_af = af;
505
506	TAILQ_INSERT_TAIL(&dyn->pfid_kif->pfik_dynaddrs, dyn, entry);
507	aw->p.dyn = dyn;
508	pfi_kif_update(dyn->pfid_kif);
509	splx(s);
510	return (0);
511
512_bad:
513	if (dyn->pfid_kt != NULL)
514		pfr_detach_table(dyn->pfid_kt);
515	if (ruleset != NULL)
516		pf_remove_if_empty_ruleset(ruleset);
517	if (dyn->pfid_kif != NULL)
518		pfi_kif_unref(dyn->pfid_kif, PFI_KIF_REF_RULE);
519	pool_put(&pfi_addr_pl, dyn);
520	splx(s);
521	return (rv);
522}
523
524void
525pfi_kif_update(struct pfi_kif *kif)
526{
527	struct ifg_list		*ifgl;
528	struct pfi_dynaddr	*p;
529
530	/* update all dynaddr */
531	TAILQ_FOREACH(p, &kif->pfik_dynaddrs, entry)
532		pfi_dynaddr_update(p);
533
534	/* again for all groups kif is member of */
535	if (kif->pfik_ifp != NULL)
536		TAILQ_FOREACH(ifgl, &kif->pfik_ifp->if_groups, ifgl_next)
537			pfi_kif_update((struct pfi_kif *)
538			    ifgl->ifgl_group->ifg_pf_kif);
539}
540
541void
542pfi_dynaddr_update(struct pfi_dynaddr *dyn)
543{
544	struct pfi_kif		*kif;
545	struct pfr_ktable	*kt;
546
547	if (dyn == NULL || dyn->pfid_kif == NULL || dyn->pfid_kt == NULL)
548		panic("pfi_dynaddr_update");
549
550	kif = dyn->pfid_kif;
551	kt = dyn->pfid_kt;
552
553	if (kt->pfrkt_larg != pfi_update) {
554		/* this table needs to be brought up-to-date */
555		pfi_table_update(kt, kif, dyn->pfid_net, dyn->pfid_iflags);
556		kt->pfrkt_larg = pfi_update;
557	}
558	pfr_dynaddr_update(kt, dyn);
559}
560
561void
562pfi_table_update(struct pfr_ktable *kt, struct pfi_kif *kif, int net, int flags)
563{
564	int			 e, size2 = 0;
565	struct ifg_member	*ifgm;
566
567	pfi_buffer_cnt = 0;
568
569	if (kif->pfik_ifp != NULL)
570		pfi_instance_add(kif->pfik_ifp, net, flags);
571	else if (kif->pfik_group != NULL)
572		TAILQ_FOREACH(ifgm, &kif->pfik_group->ifg_members, ifgm_next)
573			pfi_instance_add(ifgm->ifgm_ifp, net, flags);
574
575	if ((e = pfr_set_addrs(&kt->pfrkt_t, pfi_buffer, pfi_buffer_cnt, &size2,
576	    NULL, NULL, NULL, 0, PFR_TFLAG_ALLMASK)))
577		printf("pfi_table_update: cannot set %d new addresses "
578		    "into table %s: %d\n", pfi_buffer_cnt, kt->pfrkt_name, e);
579}
580
581void
582pfi_instance_add(struct ifnet *ifp, int net, int flags)
583{
584	struct ifaddr	*ia;
585	int		 got4 = 0, got6 = 0;
586	int		 net2, af;
587
588	if (ifp == NULL)
589		return;
590	TAILQ_FOREACH(ia, &ifp->if_addrlist, ifa_list) {
591		if (ia->ifa_addr == NULL)
592			continue;
593		af = ia->ifa_addr->sa_family;
594		if (af != AF_INET && af != AF_INET6)
595			continue;
596#ifdef __FreeBSD__
597		/*
598		 * XXX: For point-to-point interfaces, (ifname:0) and IPv4,
599		 *	jump over addresses without a proper route to work
600		 *	around a problem with ppp not fully removing the
601		 *	address used during IPCP.
602		 */
603		if ((ifp->if_flags & IFF_POINTOPOINT) &&
604		    !(ia->ifa_flags & IFA_ROUTE) &&
605		    (flags & PFI_AFLAG_NOALIAS) && (af == AF_INET))
606			continue;
607#endif
608		if ((flags & PFI_AFLAG_BROADCAST) && af == AF_INET6)
609			continue;
610		if ((flags & PFI_AFLAG_BROADCAST) &&
611		    !(ifp->if_flags & IFF_BROADCAST))
612			continue;
613		if ((flags & PFI_AFLAG_PEER) &&
614		    !(ifp->if_flags & IFF_POINTOPOINT))
615			continue;
616		if ((flags & PFI_AFLAG_NETWORK) && af == AF_INET6 &&
617		    IN6_IS_ADDR_LINKLOCAL(
618		    &((struct sockaddr_in6 *)ia->ifa_addr)->sin6_addr))
619			continue;
620		if (flags & PFI_AFLAG_NOALIAS) {
621			if (af == AF_INET && got4)
622				continue;
623			if (af == AF_INET6 && got6)
624				continue;
625		}
626		if (af == AF_INET)
627			got4 = 1;
628		else if (af == AF_INET6)
629			got6 = 1;
630		net2 = net;
631		if (net2 == 128 && (flags & PFI_AFLAG_NETWORK)) {
632			if (af == AF_INET)
633				net2 = pfi_unmask(&((struct sockaddr_in *)
634				    ia->ifa_netmask)->sin_addr);
635			else if (af == AF_INET6)
636				net2 = pfi_unmask(&((struct sockaddr_in6 *)
637				    ia->ifa_netmask)->sin6_addr);
638		}
639		if (af == AF_INET && net2 > 32)
640			net2 = 32;
641		if (flags & PFI_AFLAG_BROADCAST)
642			pfi_address_add(ia->ifa_broadaddr, af, net2);
643		else if (flags & PFI_AFLAG_PEER)
644			pfi_address_add(ia->ifa_dstaddr, af, net2);
645		else
646			pfi_address_add(ia->ifa_addr, af, net2);
647	}
648}
649
650void
651pfi_address_add(struct sockaddr *sa, int af, int net)
652{
653	struct pfr_addr	*p;
654	int		 i;
655
656	if (pfi_buffer_cnt >= pfi_buffer_max) {
657		int		 new_max = pfi_buffer_max * 2;
658
659		if (new_max > PFI_BUFFER_MAX) {
660			printf("pfi_address_add: address buffer full (%d/%d)\n",
661			    pfi_buffer_cnt, PFI_BUFFER_MAX);
662			return;
663		}
664		p = malloc(new_max * sizeof(*pfi_buffer), PFI_MTYPE,
665#ifdef __FreeBSD__
666		    M_NOWAIT);
667#else
668		    M_DONTWAIT);
669#endif
670		if (p == NULL) {
671			printf("pfi_address_add: no memory to grow buffer "
672			    "(%d/%d)\n", pfi_buffer_cnt, PFI_BUFFER_MAX);
673			return;
674		}
675		memcpy(pfi_buffer, p, pfi_buffer_cnt * sizeof(*pfi_buffer));
676		/* no need to zero buffer */
677		free(pfi_buffer, PFI_MTYPE);
678		pfi_buffer = p;
679		pfi_buffer_max = new_max;
680	}
681	if (af == AF_INET && net > 32)
682		net = 128;
683	p = pfi_buffer + pfi_buffer_cnt++;
684	bzero(p, sizeof(*p));
685	p->pfra_af = af;
686	p->pfra_net = net;
687	if (af == AF_INET)
688		p->pfra_ip4addr = ((struct sockaddr_in *)sa)->sin_addr;
689	else if (af == AF_INET6) {
690		p->pfra_ip6addr = ((struct sockaddr_in6 *)sa)->sin6_addr;
691		if (IN6_IS_SCOPE_EMBED(&p->pfra_ip6addr))
692			p->pfra_ip6addr.s6_addr16[1] = 0;
693	}
694	/* mask network address bits */
695	if (net < 128)
696		((caddr_t)p)[p->pfra_net/8] &= ~(0xFF >> (p->pfra_net%8));
697	for (i = (p->pfra_net+7)/8; i < sizeof(p->pfra_u); i++)
698		((caddr_t)p)[i] = 0;
699}
700
701void
702pfi_dynaddr_remove(struct pf_addr_wrap *aw)
703{
704	int	s;
705
706	if (aw->type != PF_ADDR_DYNIFTL || aw->p.dyn == NULL ||
707	    aw->p.dyn->pfid_kif == NULL || aw->p.dyn->pfid_kt == NULL)
708		return;
709
710	s = splsoftnet();
711	TAILQ_REMOVE(&aw->p.dyn->pfid_kif->pfik_dynaddrs, aw->p.dyn, entry);
712	pfi_kif_unref(aw->p.dyn->pfid_kif, PFI_KIF_REF_RULE);
713	aw->p.dyn->pfid_kif = NULL;
714	pfr_detach_table(aw->p.dyn->pfid_kt);
715	aw->p.dyn->pfid_kt = NULL;
716	pool_put(&pfi_addr_pl, aw->p.dyn);
717	aw->p.dyn = NULL;
718	splx(s);
719}
720
721void
722pfi_dynaddr_copyout(struct pf_addr_wrap *aw)
723{
724	if (aw->type != PF_ADDR_DYNIFTL || aw->p.dyn == NULL ||
725	    aw->p.dyn->pfid_kif == NULL)
726		return;
727	aw->p.dyncnt = aw->p.dyn->pfid_acnt4 + aw->p.dyn->pfid_acnt6;
728}
729
730void
731pfi_kifaddr_update(void *v)
732{
733	int			 s;
734	struct pfi_kif		*kif = (struct pfi_kif *)v;
735
736	s = splsoftnet();
737	pfi_update++;
738	pfi_kif_update(kif);
739	splx(s);
740}
741
742int
743pfi_if_compare(struct pfi_kif *p, struct pfi_kif *q)
744{
745	return (strncmp(p->pfik_name, q->pfik_name, IFNAMSIZ));
746}
747
748void
749pfi_fill_oldstatus(struct pf_status *pfs)
750{
751	struct pfi_kif		*p;
752	struct pfi_kif_cmp 	 key;
753	int			 i, j, k, s;
754
755	strlcpy(key.pfik_name, pfs->ifname, sizeof(key.pfik_name));
756	s = splsoftnet();
757	p = RB_FIND(pfi_ifhead, &pfi_ifs, (struct pfi_kif *)&key);
758	if (p == NULL) {
759		splx(s);
760		return;
761	}
762	bzero(pfs->pcounters, sizeof(pfs->pcounters));
763	bzero(pfs->bcounters, sizeof(pfs->bcounters));
764	for (i = 0; i < 2; i++)
765		for (j = 0; j < 2; j++)
766			for (k = 0; k < 2; k++) {
767				pfs->pcounters[i][j][k] =
768					p->pfik_packets[i][j][k];
769				pfs->bcounters[i][j] +=
770					p->pfik_bytes[i][j][k];
771			}
772	splx(s);
773}
774
775int
776pfi_clr_istats(const char *name)
777{
778	struct pfi_kif	*p;
779	int		 s;
780
781	s = splsoftnet();
782	RB_FOREACH(p, pfi_ifhead, &pfi_ifs) {
783		if (pfi_skip_if(name, p))
784			continue;
785		bzero(p->pfik_packets, sizeof(p->pfik_packets));
786		bzero(p->pfik_bytes, sizeof(p->pfik_bytes));
787		p->pfik_tzero = time_second;
788	}
789	splx(s);
790
791	return (0);
792}
793
794int
795pfi_get_ifaces(const char *name, struct pfi_kif *buf, int *size)
796{
797	struct pfi_kif	*p, *nextp;
798	int		 s, n = 0;
799#ifdef __FreeBSD__
800	int		 error;
801#endif
802
803	s = splsoftnet();
804	for (p = RB_MIN(pfi_ifhead, &pfi_ifs); p; p = nextp) {
805		nextp = RB_NEXT(pfi_ifhead, &pfi_ifs, p);
806		if (pfi_skip_if(name, p))
807			continue;
808		if (*size > n++) {
809			if (!p->pfik_tzero)
810				p->pfik_tzero = time_second;
811			pfi_kif_ref(p, PFI_KIF_REF_RULE);
812#ifdef __FreeBSD__
813			PF_COPYOUT(p, buf++, sizeof(*buf), error);
814			if (error) {
815#else
816			if (copyout(p, buf++, sizeof(*buf))) {
817#endif
818				pfi_kif_unref(p, PFI_KIF_REF_RULE);
819				splx(s);
820				return (EFAULT);
821			}
822			nextp = RB_NEXT(pfi_ifhead, &pfi_ifs, p);
823			pfi_kif_unref(p, PFI_KIF_REF_RULE);
824		}
825	}
826	splx(s);
827	*size = n;
828	return (0);
829}
830
831int
832pfi_skip_if(const char *filter, struct pfi_kif *p)
833{
834	int	n;
835
836	if (filter == NULL || !*filter)
837		return (0);
838	if (!strcmp(p->pfik_name, filter))
839		return (0);	/* exact match */
840	n = strlen(filter);
841	if (n < 1 || n >= IFNAMSIZ)
842		return (1);	/* sanity check */
843	if (filter[n-1] >= '0' && filter[n-1] <= '9')
844		return (1);	/* only do exact match in that case */
845	if (strncmp(p->pfik_name, filter, n))
846		return (1);	/* prefix doesn't match */
847	return (p->pfik_name[n] < '0' || p->pfik_name[n] > '9');
848}
849
850int
851pfi_set_flags(const char *name, int flags)
852{
853	struct pfi_kif	*p;
854	int		 s;
855
856	s = splsoftnet();
857	RB_FOREACH(p, pfi_ifhead, &pfi_ifs) {
858		if (pfi_skip_if(name, p))
859			continue;
860		p->pfik_flags |= flags;
861	}
862	splx(s);
863	return (0);
864}
865
866int
867pfi_clear_flags(const char *name, int flags)
868{
869	struct pfi_kif	*p;
870	int		 s;
871
872	s = splsoftnet();
873	RB_FOREACH(p, pfi_ifhead, &pfi_ifs) {
874		if (pfi_skip_if(name, p))
875			continue;
876		p->pfik_flags &= ~flags;
877	}
878	splx(s);
879	return (0);
880}
881
882/* from pf_print_state.c */
883int
884pfi_unmask(void *addr)
885{
886	struct pf_addr *m = addr;
887	int i = 31, j = 0, b = 0;
888	u_int32_t tmp;
889
890	while (j < 4 && m->addr32[j] == 0xffffffff) {
891		b += 32;
892		j++;
893	}
894	if (j < 4) {
895		tmp = ntohl(m->addr32[j]);
896		for (i = 31; tmp & (1 << i); --i)
897			b++;
898	}
899	return (b);
900}
901
902#ifdef __FreeBSD__
903void
904pfi_attach_ifnet_event(void *arg __unused, struct ifnet *ifp)
905{
906	PF_LOCK();
907	pfi_attach_ifnet(ifp);
908#ifdef ALTQ
909	pf_altq_ifnet_event(ifp, 0);
910#endif
911	PF_UNLOCK();
912}
913
914void
915pfi_detach_ifnet_event(void *arg __unused, struct ifnet *ifp)
916{
917	PF_LOCK();
918	pfi_detach_ifnet(ifp);
919#ifdef ALTQ
920	pf_altq_ifnet_event(ifp, 1);
921#endif
922	PF_UNLOCK();
923}
924
925void
926pfi_attach_group_event(void *arg __unused, struct ifg_group *ifg)
927{
928	PF_LOCK();
929	pfi_attach_ifgroup(ifg);
930	PF_UNLOCK();
931}
932
933void
934pfi_change_group_event(void *arg __unused, char *gname)
935{
936	PF_LOCK();
937	pfi_group_change(gname);
938	PF_UNLOCK();
939}
940
941void
942pfi_detach_group_event(void *arg __unused, struct ifg_group *ifg)
943{
944	PF_LOCK();
945	pfi_detach_ifgroup(ifg);
946	PF_UNLOCK();
947}
948
949void
950pfi_ifaddr_event(void *arg __unused, struct ifnet *ifp)
951{
952	PF_LOCK();
953	if (ifp && ifp->if_pf_kif)
954		pfi_kifaddr_update(ifp->if_pf_kif);
955	PF_UNLOCK();
956}
957#endif /* __FreeBSD__ */
958