pf_if.c revision 1.21 1 /* $NetBSD: pf_if.c,v 1.21 2010/04/12 13:57:38 ahoka 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 (at) openbsd.org>
6 * Copyright 2005 Ryan McBride <mcbride (at) 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.21 2010/04/12 13:57:38 ahoka Exp $");
38
39 #ifdef _KERNEL_OPT
40 #include "opt_inet.h"
41 #include "opt_pfil_hooks.h"
42 #endif
43
44 #include <sys/param.h>
45 #include <sys/systm.h>
46 #include <sys/mbuf.h>
47 #include <sys/filio.h>
48 #include <sys/socket.h>
49 #include <sys/socketvar.h>
50 #include <sys/kernel.h>
51 #include <sys/device.h>
52 #include <sys/time.h>
53
54 #include <net/if.h>
55 #include <net/if_types.h>
56
57 #include <netinet/in.h>
58 #include <netinet/in_var.h>
59 #include <netinet/in_systm.h>
60 #include <netinet/ip.h>
61 #include <netinet/ip_var.h>
62
63 #include <net/pfvar.h>
64
65 #ifdef INET6
66 #include <netinet/ip6.h>
67 #endif /* INET6 */
68
69 struct pfi_kif *pfi_all = NULL;
70 struct pool pfi_addr_pl;
71 struct pfi_ifhead pfi_ifs;
72 long pfi_update = 1;
73 struct pfr_addr *pfi_buffer;
74 int pfi_buffer_cnt;
75 int pfi_buffer_max;
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 #ifdef __NetBSD__
88 void pfi_init_groups(struct ifnet *);
89 void pfi_destroy_groups(struct ifnet *);
90
91 int pfil_ifnet_wrapper(void *, struct mbuf **, struct ifnet *, int);
92 int pfil_ifaddr_wrapper(void *, struct mbuf **, struct ifnet *, int);
93 #endif
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 #define PFI_MTYPE M_IFADDR
100
101 void
102 pfi_initialize(void)
103 {
104 #ifdef __NetBSD__
105 int i;
106 #endif /* __NetBSD__ */
107
108 if (pfi_all != NULL) /* already initialized */
109 return;
110
111 #ifdef __NetBSD__
112 pool_init(&pfi_addr_pl, sizeof(struct pfi_dynaddr), 0, 0, 0,
113 "pfiaddrpl", &pool_allocator_nointr, IPL_NONE);
114 #else
115 pool_init(&pfi_addr_pl, sizeof(struct pfi_dynaddr), 0, 0, 0,
116 "pfiaddrpl", &pool_allocator_nointr);
117 #endif /* !__NetBSD__ */
118 pfi_buffer_max = 64;
119 pfi_buffer = malloc(pfi_buffer_max * sizeof(*pfi_buffer),
120 PFI_MTYPE, M_WAITOK);
121
122 if ((pfi_all = pfi_kif_get(IFG_ALL)) == NULL)
123 panic("pfi_kif_get for pfi_all failed");
124
125 #ifdef __NetBSD__
126 for (i = 0; i < if_indexlim; i++) {
127 struct ifnet *ifp = ifindex2ifnet[i];
128
129 if (ifp != NULL) {
130 pfi_init_groups(ifp);
131
132 pfi_attach_ifnet(ifp);
133 }
134 }
135
136 pfil_add_hook(pfil_ifnet_wrapper, NULL, PFIL_IFNET, &if_pfil);
137 pfil_add_hook(pfil_ifaddr_wrapper, NULL, PFIL_IFADDR, &if_pfil);
138 #endif /* __NetBSD__ */
139 }
140
141 #ifdef _MODULE
142 void
143 pfi_destroy(void)
144 {
145 struct pfi_kif *p;
146 int i;
147
148 pfil_remove_hook(pfil_ifaddr_wrapper, NULL, PFIL_IFADDR, &if_pfil);
149 pfil_remove_hook(pfil_ifnet_wrapper, NULL, PFIL_IFNET, &if_pfil);
150
151 for (i = 0; i < if_indexlim; i++) {
152 struct ifnet *ifp = ifindex2ifnet[i];
153
154 if (ifp != NULL) {
155 pfi_detach_ifnet(ifp);
156
157 pfi_destroy_groups(ifp);
158 }
159 }
160
161 while ((p = RB_MIN(pfi_ifhead, &pfi_ifs))) {
162 RB_REMOVE(pfi_ifhead, &pfi_ifs, p);
163 free(p, PFI_MTYPE);
164 }
165
166 pool_destroy(&pfi_addr_pl);
167
168 free(pfi_buffer, PFI_MTYPE);
169 }
170 #endif /* _MODULE */
171
172 struct pfi_kif *
173 pfi_kif_get(const char *kif_name)
174 {
175 struct pfi_kif *kif;
176 struct pfi_kif_cmp s;
177
178 bzero(&s, sizeof(s));
179 strlcpy(s.pfik_name, kif_name, sizeof(s.pfik_name));
180 if ((kif = RB_FIND(pfi_ifhead, &pfi_ifs, (struct pfi_kif *)&s)) != NULL)
181 return (kif);
182
183 /* create new one */
184 if ((kif = malloc(sizeof(*kif), PFI_MTYPE, M_NOWAIT|M_ZERO)) == NULL)
185 return (NULL);
186
187 strlcpy(kif->pfik_name, kif_name, sizeof(kif->pfik_name));
188 #ifdef __NetBSD__
189 /* time_second is not valid yet */
190 kif->pfik_tzero = (time_second > 7200) ? time_second : 0;
191 #else
192 kif->pfik_tzero = time_second;
193 #endif /* !__NetBSD__ */
194 TAILQ_INIT(&kif->pfik_dynaddrs);
195
196 RB_INSERT(pfi_ifhead, &pfi_ifs, kif);
197 return (kif);
198 }
199
200 void
201 pfi_kif_ref(struct pfi_kif *kif, enum pfi_kif_refs what)
202 {
203 switch (what) {
204 case PFI_KIF_REF_RULE:
205 kif->pfik_rules++;
206 break;
207 case PFI_KIF_REF_STATE:
208 kif->pfik_states++;
209 break;
210 default:
211 panic("pfi_kif_ref with unknown type");
212 }
213 }
214
215 void
216 pfi_kif_unref(struct pfi_kif *kif, enum pfi_kif_refs what)
217 {
218 if (kif == NULL)
219 return;
220
221 switch (what) {
222 case PFI_KIF_REF_NONE:
223 break;
224 case PFI_KIF_REF_RULE:
225 if (kif->pfik_rules <= 0) {
226 printf("pfi_kif_unref: rules refcount <= 0\n");
227 return;
228 }
229 kif->pfik_rules--;
230 break;
231 case PFI_KIF_REF_STATE:
232 if (kif->pfik_states <= 0) {
233 printf("pfi_kif_unref: state refcount <= 0\n");
234 return;
235 }
236 kif->pfik_states--;
237 break;
238 default:
239 panic("pfi_kif_unref with unknown type");
240 }
241
242 if (kif->pfik_ifp != NULL || kif->pfik_group != NULL || kif == pfi_all)
243 return;
244
245 if (kif->pfik_rules || kif->pfik_states)
246 return;
247
248 RB_REMOVE(pfi_ifhead, &pfi_ifs, kif);
249 free(kif, PFI_MTYPE);
250 }
251
252 int
253 pfi_kif_match(struct pfi_kif *rule_kif, struct pfi_kif *packet_kif)
254 {
255 struct ifg_list *p;
256
257 if (rule_kif == NULL || rule_kif == packet_kif)
258 return (1);
259
260 if (rule_kif->pfik_group != NULL) {
261 struct ifg_list_head *ifgh =
262 if_get_groups(packet_kif->pfik_ifp);
263
264 TAILQ_FOREACH(p, ifgh, ifgl_next)
265 if (p->ifgl_group == rule_kif->pfik_group)
266 return (1);
267 }
268
269 return (0);
270 }
271
272 void
273 pfi_attach_ifnet(struct ifnet *ifp)
274 {
275 struct pfi_kif *kif;
276 int s;
277
278 pfi_initialize();
279 s = splsoftnet();
280 pfi_update++;
281 if ((kif = pfi_kif_get(ifp->if_xname)) == NULL)
282 panic("pfi_kif_get failed");
283
284 kif->pfik_ifp = ifp;
285 ifp->if_pf_kif = kif;
286
287 #ifndef __NetBSD__
288 if ((kif->pfik_ah_cookie = hook_establish(ifp->if_addrhooks, 1,
289 pfi_kifaddr_update, kif)) == NULL)
290 panic("pfi_attach_ifnet: cannot allocate '%s' address hook",
291 ifp->if_xname);
292 #endif /* !__NetBSD__ */
293
294 pfi_kif_update(kif);
295
296 splx(s);
297 }
298
299 void
300 pfi_detach_ifnet(struct ifnet *ifp)
301 {
302 int s;
303 struct pfi_kif *kif;
304
305 if ((kif = (struct pfi_kif *)ifp->if_pf_kif) == NULL)
306 return;
307
308 s = splsoftnet();
309 pfi_update++;
310 #ifndef __NetBSD__
311 hook_disestablish(ifp->if_addrhooks, kif->pfik_ah_cookie);
312 #endif /* !__NetBSD__ */
313 pfi_kif_update(kif);
314
315 kif->pfik_ifp = NULL;
316 ifp->if_pf_kif = NULL;
317 pfi_kif_unref(kif, PFI_KIF_REF_NONE);
318 splx(s);
319 }
320
321 void
322 pfi_attach_ifgroup(struct ifg_group *ifg)
323 {
324 struct pfi_kif *kif;
325 int s;
326
327 pfi_initialize();
328 s = splsoftnet();
329 pfi_update++;
330 if ((kif = pfi_kif_get(ifg->ifg_group)) == NULL)
331 panic("pfi_kif_get failed");
332
333 kif->pfik_group = ifg;
334 ifg->ifg_pf_kif = kif;
335
336 splx(s);
337 }
338
339 void
340 pfi_detach_ifgroup(struct ifg_group *ifg)
341 {
342 int s;
343 struct pfi_kif *kif;
344
345 if ((kif = (struct pfi_kif *)ifg->ifg_pf_kif) == NULL)
346 return;
347
348 s = splsoftnet();
349 pfi_update++;
350
351 kif->pfik_group = NULL;
352 ifg->ifg_pf_kif = NULL;
353 pfi_kif_unref(kif, PFI_KIF_REF_NONE);
354 splx(s);
355 }
356
357 void
358 pfi_group_change(const char *group)
359 {
360 struct pfi_kif *kif;
361 int s;
362
363 s = splsoftnet();
364 pfi_update++;
365 if ((kif = pfi_kif_get(group)) == NULL)
366 panic("pfi_kif_get failed");
367
368 pfi_kif_update(kif);
369
370 splx(s);
371 }
372
373 int
374 pfi_match_addr(struct pfi_dynaddr *dyn, struct pf_addr *a, sa_family_t af)
375 {
376 switch (af) {
377 #ifdef INET
378 case AF_INET:
379 switch (dyn->pfid_acnt4) {
380 case 0:
381 return (0);
382 case 1:
383 return (PF_MATCHA(0, &dyn->pfid_addr4,
384 &dyn->pfid_mask4, a, AF_INET));
385 default:
386 return (pfr_match_addr(dyn->pfid_kt, a, AF_INET));
387 }
388 break;
389 #endif /* INET */
390 #ifdef INET6
391 case AF_INET6:
392 switch (dyn->pfid_acnt6) {
393 case 0:
394 return (0);
395 case 1:
396 return (PF_MATCHA(0, &dyn->pfid_addr6,
397 &dyn->pfid_mask6, a, AF_INET6));
398 default:
399 return (pfr_match_addr(dyn->pfid_kt, a, AF_INET6));
400 }
401 break;
402 #endif /* INET6 */
403 default:
404 return (0);
405 }
406 }
407
408 int
409 pfi_dynaddr_setup(struct pf_addr_wrap *aw, sa_family_t af)
410 {
411 struct pfi_dynaddr *dyn;
412 char tblname[PF_TABLE_NAME_SIZE];
413 struct pf_ruleset *ruleset = NULL;
414 int s, rv = 0;
415
416 if (aw->type != PF_ADDR_DYNIFTL)
417 return (0);
418 if ((dyn = pool_get(&pfi_addr_pl, PR_NOWAIT)) == NULL)
419 return (1);
420 bzero(dyn, sizeof(*dyn));
421
422 s = splsoftnet();
423 if (!strcmp(aw->v.ifname, "self"))
424 dyn->pfid_kif = pfi_kif_get(IFG_ALL);
425 else
426 dyn->pfid_kif = pfi_kif_get(aw->v.ifname);
427 if (dyn->pfid_kif == NULL) {
428 rv = 1;
429 goto _bad;
430 }
431 pfi_kif_ref(dyn->pfid_kif, PFI_KIF_REF_RULE);
432
433 dyn->pfid_net = pfi_unmask(&aw->v.a.mask);
434 if (af == AF_INET && dyn->pfid_net == 32)
435 dyn->pfid_net = 128;
436 strlcpy(tblname, aw->v.ifname, sizeof(tblname));
437 if (aw->iflags & PFI_AFLAG_NETWORK)
438 strlcat(tblname, ":network", sizeof(tblname));
439 if (aw->iflags & PFI_AFLAG_BROADCAST)
440 strlcat(tblname, ":broadcast", sizeof(tblname));
441 if (aw->iflags & PFI_AFLAG_PEER)
442 strlcat(tblname, ":peer", sizeof(tblname));
443 if (aw->iflags & PFI_AFLAG_NOALIAS)
444 strlcat(tblname, ":0", sizeof(tblname));
445 if (dyn->pfid_net != 128)
446 snprintf(tblname + strlen(tblname),
447 sizeof(tblname) - strlen(tblname), "/%d", dyn->pfid_net);
448 if ((ruleset = pf_find_or_create_ruleset(PF_RESERVED_ANCHOR)) == NULL) {
449 rv = 1;
450 goto _bad;
451 }
452
453 if ((dyn->pfid_kt = pfr_attach_table(ruleset, tblname)) == NULL) {
454 rv = 1;
455 goto _bad;
456 }
457
458 dyn->pfid_kt->pfrkt_flags |= PFR_TFLAG_ACTIVE;
459 dyn->pfid_iflags = aw->iflags;
460 dyn->pfid_af = af;
461
462 TAILQ_INSERT_TAIL(&dyn->pfid_kif->pfik_dynaddrs, dyn, entry);
463 aw->p.dyn = dyn;
464 pfi_kif_update(dyn->pfid_kif);
465 splx(s);
466 return (0);
467
468 _bad:
469 if (dyn->pfid_kt != NULL)
470 pfr_detach_table(dyn->pfid_kt);
471 if (ruleset != NULL)
472 pf_remove_if_empty_ruleset(ruleset);
473 if (dyn->pfid_kif != NULL)
474 pfi_kif_unref(dyn->pfid_kif, PFI_KIF_REF_RULE);
475 pool_put(&pfi_addr_pl, dyn);
476 splx(s);
477 return (rv);
478 }
479
480 void
481 pfi_kif_update(struct pfi_kif *kif)
482 {
483 struct ifg_list *ifgl;
484 struct pfi_dynaddr *p;
485
486 /* update all dynaddr */
487 TAILQ_FOREACH(p, &kif->pfik_dynaddrs, entry)
488 pfi_dynaddr_update(p);
489
490 /* again for all groups kif is member of */
491 if (kif->pfik_ifp != NULL) {
492 struct ifg_list_head *ifgh = if_get_groups(kif->pfik_ifp);
493
494 TAILQ_FOREACH(ifgl, ifgh, ifgl_next)
495 pfi_kif_update((struct pfi_kif *)
496 ifgl->ifgl_group->ifg_pf_kif);
497 }
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 printf("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 *ia;
544 int got4 = 0, got6 = 0;
545 int net2, af;
546
547 if (ifp == NULL)
548 return;
549 IFADDR_FOREACH(ia, ifp) {
550 if (ia->ifa_addr == NULL)
551 continue;
552 af = ia->ifa_addr->sa_family;
553 if (af != AF_INET && af != AF_INET6)
554 continue;
555 if ((flags & PFI_AFLAG_BROADCAST) && af == AF_INET6)
556 continue;
557 if ((flags & PFI_AFLAG_BROADCAST) &&
558 !(ifp->if_flags & IFF_BROADCAST))
559 continue;
560 if ((flags & PFI_AFLAG_PEER) &&
561 !(ifp->if_flags & IFF_POINTOPOINT))
562 continue;
563 if ((flags & PFI_AFLAG_NETWORK) && af == AF_INET6 &&
564 IN6_IS_ADDR_LINKLOCAL(
565 &((struct sockaddr_in6 *)ia->ifa_addr)->sin6_addr))
566 continue;
567 if (flags & PFI_AFLAG_NOALIAS) {
568 if (af == AF_INET && got4)
569 continue;
570 if (af == AF_INET6 && got6)
571 continue;
572 }
573 if (af == AF_INET)
574 got4 = 1;
575 else if (af == AF_INET6)
576 got6 = 1;
577 net2 = net;
578 if (net2 == 128 && (flags & PFI_AFLAG_NETWORK)) {
579 if (af == AF_INET)
580 net2 = pfi_unmask(&((struct sockaddr_in *)
581 ia->ifa_netmask)->sin_addr);
582 else if (af == AF_INET6)
583 net2 = pfi_unmask(&((struct sockaddr_in6 *)
584 ia->ifa_netmask)->sin6_addr);
585 }
586 if (af == AF_INET && net2 > 32)
587 net2 = 32;
588 if (flags & PFI_AFLAG_BROADCAST)
589 pfi_address_add(ia->ifa_broadaddr, af, net2);
590 else if (flags & PFI_AFLAG_PEER)
591 pfi_address_add(ia->ifa_dstaddr, af, net2);
592 else
593 pfi_address_add(ia->ifa_addr, af, net2);
594 }
595 }
596
597 void
598 pfi_address_add(struct sockaddr *sa, int af, int net)
599 {
600 struct pfr_addr *p;
601 int i;
602
603 if (pfi_buffer_cnt >= pfi_buffer_max) {
604 int new_max = pfi_buffer_max * 2;
605
606 if (new_max > PFI_BUFFER_MAX) {
607 printf("pfi_address_add: address buffer full (%d/%d)\n",
608 pfi_buffer_cnt, PFI_BUFFER_MAX);
609 return;
610 }
611 p = malloc(new_max * sizeof(*pfi_buffer), PFI_MTYPE, M_NOWAIT);
612 if (p == NULL) {
613 printf("pfi_address_add: no memory to grow buffer "
614 "(%d/%d)\n", pfi_buffer_cnt, PFI_BUFFER_MAX);
615 return;
616 }
617 memcpy(p, pfi_buffer, pfi_buffer_cnt * sizeof(*pfi_buffer));
618 /* no need to zero buffer */
619 free(pfi_buffer, PFI_MTYPE);
620 pfi_buffer = p;
621 pfi_buffer_max = new_max;
622 }
623 if (af == AF_INET && net > 32)
624 net = 128;
625 p = pfi_buffer + pfi_buffer_cnt++;
626 bzero(p, sizeof(*p));
627 p->pfra_af = af;
628 p->pfra_net = net;
629 if (af == AF_INET)
630 p->pfra_ip4addr = ((struct sockaddr_in *)sa)->sin_addr;
631 else if (af == AF_INET6) {
632 p->pfra_ip6addr = ((struct sockaddr_in6 *)sa)->sin6_addr;
633 if (IN6_IS_SCOPE_EMBEDDABLE(&p->pfra_ip6addr))
634 p->pfra_ip6addr.s6_addr16[1] = 0;
635 }
636 /* mask network address bits */
637 if (net < 128)
638 ((char *)p)[p->pfra_net/8] &= ~(0xFF >> (p->pfra_net%8));
639 for (i = (p->pfra_net+7)/8; i < sizeof(p->pfra_u); i++)
640 ((char *)p)[i] = 0;
641 }
642
643 void
644 pfi_dynaddr_remove(struct pf_addr_wrap *aw)
645 {
646 int s;
647
648 if (aw->type != PF_ADDR_DYNIFTL || aw->p.dyn == NULL ||
649 aw->p.dyn->pfid_kif == NULL || aw->p.dyn->pfid_kt == NULL)
650 return;
651
652 s = splsoftnet();
653 TAILQ_REMOVE(&aw->p.dyn->pfid_kif->pfik_dynaddrs, aw->p.dyn, entry);
654 pfi_kif_unref(aw->p.dyn->pfid_kif, PFI_KIF_REF_RULE);
655 aw->p.dyn->pfid_kif = NULL;
656 pfr_detach_table(aw->p.dyn->pfid_kt);
657 aw->p.dyn->pfid_kt = NULL;
658 pool_put(&pfi_addr_pl, aw->p.dyn);
659 aw->p.dyn = NULL;
660 splx(s);
661 }
662
663 void
664 pfi_dynaddr_copyout(struct pf_addr_wrap *aw)
665 {
666 if (aw->type != PF_ADDR_DYNIFTL || aw->p.dyn == NULL ||
667 aw->p.dyn->pfid_kif == NULL)
668 return;
669 aw->p.dyncnt = aw->p.dyn->pfid_acnt4 + aw->p.dyn->pfid_acnt6;
670 }
671
672 void
673 pfi_kifaddr_update(void *v)
674 {
675 int s;
676 struct pfi_kif *kif = (struct pfi_kif *)v;
677
678 s = splsoftnet();
679 pfi_update++;
680 pfi_kif_update(kif);
681 splx(s);
682 }
683
684 int
685 pfi_if_compare(struct pfi_kif *p, struct pfi_kif *q)
686 {
687 return (strncmp(p->pfik_name, q->pfik_name, IFNAMSIZ));
688 }
689
690 void
691 pfi_fill_oldstatus(struct pf_status *pfs)
692 {
693 struct pfi_kif *p;
694 struct pfi_kif_cmp key;
695 int i, j, k, s;
696
697 strlcpy(key.pfik_name, pfs->ifname, sizeof(key.pfik_name));
698 s = splsoftnet();
699 p = RB_FIND(pfi_ifhead, &pfi_ifs, (struct pfi_kif *)&key);
700 if (p == NULL) {
701 splx(s);
702 return;
703 }
704 bzero(pfs->pcounters, sizeof(pfs->pcounters));
705 bzero(pfs->bcounters, sizeof(pfs->bcounters));
706 for (i = 0; i < 2; i++)
707 for (j = 0; j < 2; j++)
708 for (k = 0; k < 2; k++) {
709 pfs->pcounters[i][j][k] =
710 p->pfik_packets[i][j][k];
711 pfs->bcounters[i][j] +=
712 p->pfik_bytes[i][j][k];
713 }
714 splx(s);
715 }
716
717 int
718 pfi_clr_istats(const char *name)
719 {
720 struct pfi_kif *p;
721 int s;
722
723 s = splsoftnet();
724 RB_FOREACH(p, pfi_ifhead, &pfi_ifs) {
725 if (pfi_skip_if(name, p))
726 continue;
727 bzero(p->pfik_packets, sizeof(p->pfik_packets));
728 bzero(p->pfik_bytes, sizeof(p->pfik_bytes));
729 p->pfik_tzero = time_second;
730 }
731 splx(s);
732
733 return (0);
734 }
735
736 int
737 pfi_get_ifaces(const char *name, struct pfi_kif *buf, int *size)
738 {
739 struct pfi_kif *p, *nextp;
740 int s, n = 0;
741
742 s = splsoftnet();
743 for (p = RB_MIN(pfi_ifhead, &pfi_ifs); p; p = nextp) {
744 nextp = RB_NEXT(pfi_ifhead, &pfi_ifs, p);
745 if (pfi_skip_if(name, p))
746 continue;
747 if (*size > n++) {
748 if (!p->pfik_tzero)
749 p->pfik_tzero = time_second;
750 pfi_kif_ref(p, PFI_KIF_REF_RULE);
751 if (copyout(p, buf++, sizeof(*buf))) {
752 pfi_kif_unref(p, PFI_KIF_REF_RULE);
753 splx(s);
754 return (EFAULT);
755 }
756 nextp = RB_NEXT(pfi_ifhead, &pfi_ifs, p);
757 pfi_kif_unref(p, PFI_KIF_REF_RULE);
758 }
759 }
760 splx(s);
761 *size = n;
762 return (0);
763 }
764
765 int
766 pfi_skip_if(const char *filter, struct pfi_kif *p)
767 {
768 int n;
769
770 if (filter == NULL || !*filter)
771 return (0);
772 if (!strcmp(p->pfik_name, filter))
773 return (0); /* exact match */
774 n = strlen(filter);
775 if (n < 1 || n >= IFNAMSIZ)
776 return (1); /* sanity check */
777 if (filter[n-1] >= '0' && filter[n-1] <= '9')
778 return (1); /* only do exact match in that case */
779 if (strncmp(p->pfik_name, filter, n))
780 return (1); /* prefix doesn't match */
781 return (p->pfik_name[n] < '0' || p->pfik_name[n] > '9');
782 }
783
784 int
785 pfi_set_flags(const char *name, int flags)
786 {
787 struct pfi_kif *p;
788 int s;
789
790 s = splsoftnet();
791 RB_FOREACH(p, pfi_ifhead, &pfi_ifs) {
792 if (pfi_skip_if(name, p))
793 continue;
794 p->pfik_flags |= flags;
795 }
796 splx(s);
797 return (0);
798 }
799
800 int
801 pfi_clear_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
816 /* from pf_print_state.c */
817 int
818 pfi_unmask(void *addr)
819 {
820 struct pf_addr *m = addr;
821 int i = 31, j = 0, b = 0;
822 u_int32_t tmp;
823
824 while (j < 4 && m->addr32[j] == 0xffffffff) {
825 b += 32;
826 j++;
827 }
828 if (j < 4) {
829 tmp = ntohl(m->addr32[j]);
830 for (i = 31; tmp & (1 << i); --i)
831 b++;
832 }
833 return (b);
834 }
835
836 #ifdef __NetBSD__
837 static void
838 pfi_copy_group(char *dest, const char *src, ssize_t sz)
839 {
840 while (sz > 1 && *src && !(*src >= '0' && *src <= '9')) {
841 *dest++ = *src++;
842 sz--;
843 }
844 if (sz > 0)
845 *dest++ = '\0';
846 }
847
848 void
849 pfi_init_groups(struct ifnet *ifp)
850 {
851 char group[IFNAMSIZ];
852
853 if_init_groups(ifp);
854 if_addgroup(ifp, IFG_ALL);
855
856 pfi_copy_group(group, ifp->if_xname, sizeof(group));
857 if_addgroup(ifp, group);
858 }
859
860 void
861 pfi_destroy_groups(struct ifnet *ifp)
862 {
863 char group[IFNAMSIZ];
864
865 pfi_copy_group(group, ifp->if_xname, sizeof(group));
866 if_delgroup(ifp, group);
867
868 if_delgroup(ifp, IFG_ALL);
869 if_destroy_groups(ifp);
870 }
871
872 int
873 pfil_ifnet_wrapper(void *arg, struct mbuf **mp, struct ifnet *ifp, int dir)
874 {
875 u_long cmd = (u_long)mp;
876
877 switch (cmd) {
878 case PFIL_IFNET_ATTACH:
879 pfi_init_groups(ifp);
880
881 pfi_attach_ifnet(ifp);
882 break;
883 case PFIL_IFNET_DETACH:
884 pfi_detach_ifnet(ifp);
885
886 pfi_destroy_groups(ifp);
887 break;
888 default:
889 panic("pfil_ifnet_wrapper: unexpected cmd %lu", cmd);
890 }
891
892 return (0);
893 }
894
895 int
896 pfil_ifaddr_wrapper(void *arg, struct mbuf **mp, struct ifnet *ifp, int dir)
897 {
898 u_long cmd = (u_long)mp;
899
900 switch (cmd) {
901 case SIOCSIFADDR:
902 case SIOCAIFADDR:
903 case SIOCDIFADDR:
904 #ifdef INET6
905 case SIOCAIFADDR_IN6:
906 case SIOCDIFADDR_IN6:
907 #endif /* INET6 */
908 pfi_kifaddr_update(ifp->if_pf_kif);
909 break;
910 default:
911 panic("pfil_ifaddr_wrapper: unexpected ioctl %lu", cmd);
912 }
913
914 return (0);
915 }
916 #endif /* __NetBSD__ */
917