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