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