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