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