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