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