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