pf_table.c revision 1.5 1 1.5 yamt /* $NetBSD: pf_table.c,v 1.5 2004/11/14 11:12:16 yamt Exp $ */
2 1.5 yamt /* $OpenBSD: pf_table.c,v 1.59 2004/07/08 23:17:38 mcbride Exp $ */
3 1.1 itojun
4 1.1 itojun /*
5 1.1 itojun * Copyright (c) 2002 Cedric Berger
6 1.1 itojun * All rights reserved.
7 1.1 itojun *
8 1.1 itojun * Redistribution and use in source and binary forms, with or without
9 1.1 itojun * modification, are permitted provided that the following conditions
10 1.1 itojun * are met:
11 1.1 itojun *
12 1.1 itojun * - Redistributions of source code must retain the above copyright
13 1.1 itojun * notice, this list of conditions and the following disclaimer.
14 1.1 itojun * - Redistributions in binary form must reproduce the above
15 1.1 itojun * copyright notice, this list of conditions and the following
16 1.1 itojun * disclaimer in the documentation and/or other materials provided
17 1.1 itojun * with the distribution.
18 1.1 itojun *
19 1.1 itojun * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
20 1.1 itojun * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
21 1.1 itojun * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
22 1.1 itojun * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
23 1.1 itojun * COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
24 1.1 itojun * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
25 1.1 itojun * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
26 1.1 itojun * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
27 1.1 itojun * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
28 1.1 itojun * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
29 1.1 itojun * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
30 1.1 itojun * POSSIBILITY OF SUCH DAMAGE.
31 1.1 itojun *
32 1.1 itojun */
33 1.1 itojun
34 1.2 itojun #ifdef _KERNEL_OPT
35 1.2 itojun #include "opt_inet.h"
36 1.2 itojun #endif
37 1.2 itojun
38 1.1 itojun #include <sys/param.h>
39 1.1 itojun #include <sys/systm.h>
40 1.1 itojun #include <sys/socket.h>
41 1.1 itojun #include <sys/mbuf.h>
42 1.1 itojun #include <sys/kernel.h>
43 1.1 itojun
44 1.1 itojun #include <net/if.h>
45 1.1 itojun #include <net/route.h>
46 1.1 itojun #include <netinet/in.h>
47 1.2 itojun #ifdef __OpenBSD__
48 1.1 itojun #include <netinet/ip_ipsp.h>
49 1.2 itojun #endif
50 1.1 itojun #include <net/pfvar.h>
51 1.1 itojun
52 1.1 itojun #define ACCEPT_FLAGS(oklist) \
53 1.1 itojun do { \
54 1.1 itojun if ((flags & ~(oklist)) & \
55 1.1 itojun PFR_FLAG_ALLMASK) \
56 1.1 itojun return (EINVAL); \
57 1.1 itojun } while (0)
58 1.1 itojun
59 1.1 itojun #define COPYIN(from, to, size) \
60 1.1 itojun ((flags & PFR_FLAG_USERIOCTL) ? \
61 1.1 itojun copyin((from), (to), (size)) : \
62 1.1 itojun (bcopy((from), (to), (size)), 0))
63 1.1 itojun
64 1.1 itojun #define COPYOUT(from, to, size) \
65 1.1 itojun ((flags & PFR_FLAG_USERIOCTL) ? \
66 1.1 itojun copyout((from), (to), (size)) : \
67 1.1 itojun (bcopy((from), (to), (size)), 0))
68 1.1 itojun
69 1.1 itojun #define FILLIN_SIN(sin, addr) \
70 1.1 itojun do { \
71 1.1 itojun (sin).sin_len = sizeof(sin); \
72 1.1 itojun (sin).sin_family = AF_INET; \
73 1.1 itojun (sin).sin_addr = (addr); \
74 1.1 itojun } while (0)
75 1.1 itojun
76 1.1 itojun #define FILLIN_SIN6(sin6, addr) \
77 1.1 itojun do { \
78 1.1 itojun (sin6).sin6_len = sizeof(sin6); \
79 1.1 itojun (sin6).sin6_family = AF_INET6; \
80 1.1 itojun (sin6).sin6_addr = (addr); \
81 1.1 itojun } while (0)
82 1.1 itojun
83 1.1 itojun #define SWAP(type, a1, a2) \
84 1.1 itojun do { \
85 1.1 itojun type tmp = a1; \
86 1.1 itojun a1 = a2; \
87 1.1 itojun a2 = tmp; \
88 1.1 itojun } while (0)
89 1.1 itojun
90 1.1 itojun #define SUNION2PF(su, af) (((af)==AF_INET) ? \
91 1.1 itojun (struct pf_addr *)&(su)->sin.sin_addr : \
92 1.1 itojun (struct pf_addr *)&(su)->sin6.sin6_addr)
93 1.1 itojun
94 1.1 itojun #define AF_BITS(af) (((af)==AF_INET)?32:128)
95 1.1 itojun #define ADDR_NETWORK(ad) ((ad)->pfra_net < AF_BITS((ad)->pfra_af))
96 1.1 itojun #define KENTRY_NETWORK(ke) ((ke)->pfrke_net < AF_BITS((ke)->pfrke_af))
97 1.1 itojun #define KENTRY_RNF_ROOT(ke) \
98 1.1 itojun ((((struct radix_node *)(ke))->rn_flags & RNF_ROOT) != 0)
99 1.1 itojun
100 1.1 itojun #define NO_ADDRESSES (-1)
101 1.1 itojun #define ENQUEUE_UNMARKED_ONLY (1)
102 1.1 itojun #define INVERT_NEG_FLAG (1)
103 1.1 itojun
104 1.1 itojun struct pfr_walktree {
105 1.1 itojun enum pfrw_op {
106 1.1 itojun PFRW_MARK,
107 1.1 itojun PFRW_SWEEP,
108 1.1 itojun PFRW_ENQUEUE,
109 1.1 itojun PFRW_GET_ADDRS,
110 1.1 itojun PFRW_GET_ASTATS,
111 1.1 itojun PFRW_POOL_GET,
112 1.1 itojun PFRW_DYNADDR_UPDATE
113 1.1 itojun } pfrw_op;
114 1.1 itojun union {
115 1.1 itojun struct pfr_addr *pfrw1_addr;
116 1.1 itojun struct pfr_astats *pfrw1_astats;
117 1.1 itojun struct pfr_kentryworkq *pfrw1_workq;
118 1.1 itojun struct pfr_kentry *pfrw1_kentry;
119 1.1 itojun struct pfi_dynaddr *pfrw1_dyn;
120 1.1 itojun } pfrw_1;
121 1.1 itojun int pfrw_free;
122 1.1 itojun int pfrw_flags;
123 1.1 itojun };
124 1.1 itojun #define pfrw_addr pfrw_1.pfrw1_addr
125 1.1 itojun #define pfrw_astats pfrw_1.pfrw1_astats
126 1.1 itojun #define pfrw_workq pfrw_1.pfrw1_workq
127 1.1 itojun #define pfrw_kentry pfrw_1.pfrw1_kentry
128 1.1 itojun #define pfrw_dyn pfrw_1.pfrw1_dyn
129 1.1 itojun #define pfrw_cnt pfrw_free
130 1.1 itojun
131 1.1 itojun #define senderr(e) do { rv = (e); goto _bad; } while (0)
132 1.1 itojun
133 1.1 itojun struct pool pfr_ktable_pl;
134 1.1 itojun struct pool pfr_kentry_pl;
135 1.1 itojun struct sockaddr_in pfr_sin;
136 1.1 itojun struct sockaddr_in6 pfr_sin6;
137 1.1 itojun union sockaddr_union pfr_mask;
138 1.1 itojun struct pf_addr pfr_ffaddr;
139 1.1 itojun
140 1.1 itojun void pfr_copyout_addr(struct pfr_addr *,
141 1.1 itojun struct pfr_kentry *ke);
142 1.1 itojun int pfr_validate_addr(struct pfr_addr *);
143 1.1 itojun void pfr_enqueue_addrs(struct pfr_ktable *,
144 1.1 itojun struct pfr_kentryworkq *, int *, int);
145 1.1 itojun void pfr_mark_addrs(struct pfr_ktable *);
146 1.1 itojun struct pfr_kentry *pfr_lookup_addr(struct pfr_ktable *,
147 1.1 itojun struct pfr_addr *, int);
148 1.1 itojun struct pfr_kentry *pfr_create_kentry(struct pfr_addr *);
149 1.1 itojun void pfr_destroy_kentries(struct pfr_kentryworkq *);
150 1.1 itojun void pfr_destroy_kentry(struct pfr_kentry *);
151 1.1 itojun void pfr_insert_kentries(struct pfr_ktable *,
152 1.1 itojun struct pfr_kentryworkq *, long);
153 1.1 itojun void pfr_remove_kentries(struct pfr_ktable *,
154 1.1 itojun struct pfr_kentryworkq *);
155 1.1 itojun void pfr_clstats_kentries(struct pfr_kentryworkq *, long,
156 1.1 itojun int);
157 1.1 itojun void pfr_reset_feedback(struct pfr_addr *, int, int);
158 1.1 itojun void pfr_prepare_network(union sockaddr_union *, int, int);
159 1.1 itojun int pfr_route_kentry(struct pfr_ktable *,
160 1.1 itojun struct pfr_kentry *);
161 1.1 itojun int pfr_unroute_kentry(struct pfr_ktable *,
162 1.1 itojun struct pfr_kentry *);
163 1.1 itojun int pfr_walktree(struct radix_node *, void *);
164 1.1 itojun int pfr_validate_table(struct pfr_table *, int, int);
165 1.1 itojun void pfr_commit_ktable(struct pfr_ktable *, long);
166 1.1 itojun void pfr_insert_ktables(struct pfr_ktableworkq *);
167 1.1 itojun void pfr_insert_ktable(struct pfr_ktable *);
168 1.1 itojun void pfr_setflags_ktables(struct pfr_ktableworkq *);
169 1.1 itojun void pfr_setflags_ktable(struct pfr_ktable *, int);
170 1.1 itojun void pfr_clstats_ktables(struct pfr_ktableworkq *, long,
171 1.1 itojun int);
172 1.1 itojun void pfr_clstats_ktable(struct pfr_ktable *, long, int);
173 1.1 itojun struct pfr_ktable *pfr_create_ktable(struct pfr_table *, long, int);
174 1.1 itojun void pfr_destroy_ktables(struct pfr_ktableworkq *, int);
175 1.1 itojun void pfr_destroy_ktable(struct pfr_ktable *, int);
176 1.1 itojun int pfr_ktable_compare(struct pfr_ktable *,
177 1.1 itojun struct pfr_ktable *);
178 1.1 itojun struct pfr_ktable *pfr_lookup_table(struct pfr_table *);
179 1.1 itojun void pfr_clean_node_mask(struct pfr_ktable *,
180 1.1 itojun struct pfr_kentryworkq *);
181 1.1 itojun int pfr_table_count(struct pfr_table *, int);
182 1.1 itojun int pfr_skip_table(struct pfr_table *,
183 1.1 itojun struct pfr_ktable *, int);
184 1.1 itojun struct pfr_kentry *pfr_kentry_byidx(struct pfr_ktable *, int, int);
185 1.1 itojun
186 1.1 itojun RB_PROTOTYPE(pfr_ktablehead, pfr_ktable, pfrkt_tree, pfr_ktable_compare);
187 1.1 itojun RB_GENERATE(pfr_ktablehead, pfr_ktable, pfrkt_tree, pfr_ktable_compare);
188 1.1 itojun
189 1.1 itojun struct pfr_ktablehead pfr_ktables;
190 1.1 itojun struct pfr_table pfr_nulltable;
191 1.1 itojun int pfr_ktable_cnt;
192 1.1 itojun
193 1.1 itojun void
194 1.1 itojun pfr_initialize(void)
195 1.1 itojun {
196 1.1 itojun pool_init(&pfr_ktable_pl, sizeof(struct pfr_ktable), 0, 0, 0,
197 1.5 yamt "pfrktable", &pool_allocator_oldnointr);
198 1.1 itojun pool_init(&pfr_kentry_pl, sizeof(struct pfr_kentry), 0, 0, 0,
199 1.5 yamt "pfrkentry", &pool_allocator_oldnointr);
200 1.1 itojun
201 1.1 itojun pfr_sin.sin_len = sizeof(pfr_sin);
202 1.1 itojun pfr_sin.sin_family = AF_INET;
203 1.1 itojun pfr_sin6.sin6_len = sizeof(pfr_sin6);
204 1.1 itojun pfr_sin6.sin6_family = AF_INET6;
205 1.1 itojun
206 1.1 itojun memset(&pfr_ffaddr, 0xff, sizeof(pfr_ffaddr));
207 1.1 itojun }
208 1.1 itojun
209 1.3 itojun #ifdef _LKM
210 1.3 itojun void
211 1.3 itojun pfr_destroy(void)
212 1.3 itojun {
213 1.3 itojun pool_destroy(&pfr_ktable_pl);
214 1.3 itojun pool_destroy(&pfr_kentry_pl);
215 1.3 itojun }
216 1.3 itojun #endif
217 1.3 itojun
218 1.1 itojun int
219 1.1 itojun pfr_clr_addrs(struct pfr_table *tbl, int *ndel, int flags)
220 1.1 itojun {
221 1.1 itojun struct pfr_ktable *kt;
222 1.1 itojun struct pfr_kentryworkq workq;
223 1.2 itojun int s = 0;
224 1.1 itojun
225 1.1 itojun ACCEPT_FLAGS(PFR_FLAG_ATOMIC+PFR_FLAG_DUMMY);
226 1.1 itojun if (pfr_validate_table(tbl, 0, flags & PFR_FLAG_USERIOCTL))
227 1.1 itojun return (EINVAL);
228 1.1 itojun kt = pfr_lookup_table(tbl);
229 1.1 itojun if (kt == NULL || !(kt->pfrkt_flags & PFR_TFLAG_ACTIVE))
230 1.1 itojun return (ESRCH);
231 1.1 itojun if (kt->pfrkt_flags & PFR_TFLAG_CONST)
232 1.1 itojun return (EPERM);
233 1.1 itojun pfr_enqueue_addrs(kt, &workq, ndel, 0);
234 1.1 itojun
235 1.1 itojun if (!(flags & PFR_FLAG_DUMMY)) {
236 1.1 itojun if (flags & PFR_FLAG_ATOMIC)
237 1.1 itojun s = splsoftnet();
238 1.1 itojun pfr_remove_kentries(kt, &workq);
239 1.1 itojun if (flags & PFR_FLAG_ATOMIC)
240 1.1 itojun splx(s);
241 1.1 itojun if (kt->pfrkt_cnt) {
242 1.1 itojun printf("pfr_clr_addrs: corruption detected (%d).\n",
243 1.1 itojun kt->pfrkt_cnt);
244 1.1 itojun kt->pfrkt_cnt = 0;
245 1.1 itojun }
246 1.1 itojun }
247 1.1 itojun return (0);
248 1.1 itojun }
249 1.1 itojun
250 1.1 itojun int
251 1.1 itojun pfr_add_addrs(struct pfr_table *tbl, struct pfr_addr *addr, int size,
252 1.1 itojun int *nadd, int flags)
253 1.1 itojun {
254 1.1 itojun struct pfr_ktable *kt, *tmpkt;
255 1.1 itojun struct pfr_kentryworkq workq;
256 1.1 itojun struct pfr_kentry *p, *q;
257 1.1 itojun struct pfr_addr ad;
258 1.5 yamt int i, rv, s = 0 /* XXX gcc */, xadd = 0;
259 1.5 yamt long tzero = time_second;
260 1.1 itojun
261 1.1 itojun ACCEPT_FLAGS(PFR_FLAG_ATOMIC+PFR_FLAG_DUMMY+PFR_FLAG_FEEDBACK);
262 1.1 itojun if (pfr_validate_table(tbl, 0, flags & PFR_FLAG_USERIOCTL))
263 1.1 itojun return (EINVAL);
264 1.1 itojun kt = pfr_lookup_table(tbl);
265 1.1 itojun if (kt == NULL || !(kt->pfrkt_flags & PFR_TFLAG_ACTIVE))
266 1.1 itojun return (ESRCH);
267 1.1 itojun if (kt->pfrkt_flags & PFR_TFLAG_CONST)
268 1.1 itojun return (EPERM);
269 1.1 itojun tmpkt = pfr_create_ktable(&pfr_nulltable, 0, 0);
270 1.1 itojun if (tmpkt == NULL)
271 1.1 itojun return (ENOMEM);
272 1.1 itojun SLIST_INIT(&workq);
273 1.1 itojun for (i = 0; i < size; i++) {
274 1.1 itojun if (COPYIN(addr+i, &ad, sizeof(ad)))
275 1.1 itojun senderr(EFAULT);
276 1.1 itojun if (pfr_validate_addr(&ad))
277 1.1 itojun senderr(EINVAL);
278 1.1 itojun p = pfr_lookup_addr(kt, &ad, 1);
279 1.1 itojun q = pfr_lookup_addr(tmpkt, &ad, 1);
280 1.1 itojun if (flags & PFR_FLAG_FEEDBACK) {
281 1.1 itojun if (q != NULL)
282 1.1 itojun ad.pfra_fback = PFR_FB_DUPLICATE;
283 1.1 itojun else if (p == NULL)
284 1.1 itojun ad.pfra_fback = PFR_FB_ADDED;
285 1.1 itojun else if (p->pfrke_not != ad.pfra_not)
286 1.1 itojun ad.pfra_fback = PFR_FB_CONFLICT;
287 1.1 itojun else
288 1.1 itojun ad.pfra_fback = PFR_FB_NONE;
289 1.1 itojun }
290 1.1 itojun if (p == NULL && q == NULL) {
291 1.1 itojun p = pfr_create_kentry(&ad);
292 1.1 itojun if (p == NULL)
293 1.1 itojun senderr(ENOMEM);
294 1.1 itojun if (pfr_route_kentry(tmpkt, p)) {
295 1.1 itojun pfr_destroy_kentry(p);
296 1.1 itojun ad.pfra_fback = PFR_FB_NONE;
297 1.1 itojun } else {
298 1.1 itojun SLIST_INSERT_HEAD(&workq, p, pfrke_workq);
299 1.1 itojun xadd++;
300 1.1 itojun }
301 1.1 itojun }
302 1.1 itojun if (flags & PFR_FLAG_FEEDBACK)
303 1.1 itojun if (COPYOUT(&ad, addr+i, sizeof(ad)))
304 1.1 itojun senderr(EFAULT);
305 1.1 itojun }
306 1.1 itojun pfr_clean_node_mask(tmpkt, &workq);
307 1.1 itojun if (!(flags & PFR_FLAG_DUMMY)) {
308 1.1 itojun if (flags & PFR_FLAG_ATOMIC)
309 1.1 itojun s = splsoftnet();
310 1.1 itojun pfr_insert_kentries(kt, &workq, tzero);
311 1.1 itojun if (flags & PFR_FLAG_ATOMIC)
312 1.1 itojun splx(s);
313 1.1 itojun } else
314 1.1 itojun pfr_destroy_kentries(&workq);
315 1.1 itojun if (nadd != NULL)
316 1.1 itojun *nadd = xadd;
317 1.1 itojun pfr_destroy_ktable(tmpkt, 0);
318 1.1 itojun return (0);
319 1.1 itojun _bad:
320 1.1 itojun pfr_clean_node_mask(tmpkt, &workq);
321 1.1 itojun pfr_destroy_kentries(&workq);
322 1.1 itojun if (flags & PFR_FLAG_FEEDBACK)
323 1.1 itojun pfr_reset_feedback(addr, size, flags);
324 1.1 itojun pfr_destroy_ktable(tmpkt, 0);
325 1.1 itojun return (rv);
326 1.1 itojun }
327 1.1 itojun
328 1.1 itojun int
329 1.1 itojun pfr_del_addrs(struct pfr_table *tbl, struct pfr_addr *addr, int size,
330 1.1 itojun int *ndel, int flags)
331 1.1 itojun {
332 1.1 itojun struct pfr_ktable *kt;
333 1.1 itojun struct pfr_kentryworkq workq;
334 1.1 itojun struct pfr_kentry *p;
335 1.1 itojun struct pfr_addr ad;
336 1.5 yamt int i, rv, s = 0 /* XXX gcc */, xdel = 0, log = 1;
337 1.1 itojun
338 1.1 itojun ACCEPT_FLAGS(PFR_FLAG_ATOMIC+PFR_FLAG_DUMMY+PFR_FLAG_FEEDBACK);
339 1.1 itojun if (pfr_validate_table(tbl, 0, flags & PFR_FLAG_USERIOCTL))
340 1.1 itojun return (EINVAL);
341 1.1 itojun kt = pfr_lookup_table(tbl);
342 1.1 itojun if (kt == NULL || !(kt->pfrkt_flags & PFR_TFLAG_ACTIVE))
343 1.1 itojun return (ESRCH);
344 1.1 itojun if (kt->pfrkt_flags & PFR_TFLAG_CONST)
345 1.1 itojun return (EPERM);
346 1.5 yamt /*
347 1.5 yamt * there are two algorithms to choose from here.
348 1.5 yamt * with:
349 1.5 yamt * n: number of addresses to delete
350 1.5 yamt * N: number of addresses in the table
351 1.5 yamt *
352 1.5 yamt * one is O(N) and is better for large 'n'
353 1.5 yamt * one is O(n*LOG(N)) and is better for small 'n'
354 1.5 yamt *
355 1.5 yamt * following code try to decide which one is best.
356 1.5 yamt */
357 1.5 yamt for (i = kt->pfrkt_cnt; i > 0; i >>= 1)
358 1.5 yamt log++;
359 1.5 yamt if (size > kt->pfrkt_cnt/log) {
360 1.5 yamt /* full table scan */
361 1.5 yamt pfr_mark_addrs(kt);
362 1.5 yamt } else {
363 1.5 yamt /* iterate over addresses to delete */
364 1.5 yamt for (i = 0; i < size; i++) {
365 1.5 yamt if (COPYIN(addr+i, &ad, sizeof(ad)))
366 1.5 yamt return (EFAULT);
367 1.5 yamt if (pfr_validate_addr(&ad))
368 1.5 yamt return (EINVAL);
369 1.5 yamt p = pfr_lookup_addr(kt, &ad, 1);
370 1.5 yamt if (p != NULL)
371 1.5 yamt p->pfrke_mark = 0;
372 1.5 yamt }
373 1.5 yamt }
374 1.1 itojun SLIST_INIT(&workq);
375 1.1 itojun for (i = 0; i < size; i++) {
376 1.1 itojun if (COPYIN(addr+i, &ad, sizeof(ad)))
377 1.1 itojun senderr(EFAULT);
378 1.1 itojun if (pfr_validate_addr(&ad))
379 1.1 itojun senderr(EINVAL);
380 1.1 itojun p = pfr_lookup_addr(kt, &ad, 1);
381 1.1 itojun if (flags & PFR_FLAG_FEEDBACK) {
382 1.1 itojun if (p == NULL)
383 1.1 itojun ad.pfra_fback = PFR_FB_NONE;
384 1.1 itojun else if (p->pfrke_not != ad.pfra_not)
385 1.1 itojun ad.pfra_fback = PFR_FB_CONFLICT;
386 1.1 itojun else if (p->pfrke_mark)
387 1.1 itojun ad.pfra_fback = PFR_FB_DUPLICATE;
388 1.1 itojun else
389 1.1 itojun ad.pfra_fback = PFR_FB_DELETED;
390 1.1 itojun }
391 1.1 itojun if (p != NULL && p->pfrke_not == ad.pfra_not &&
392 1.1 itojun !p->pfrke_mark) {
393 1.1 itojun p->pfrke_mark = 1;
394 1.1 itojun SLIST_INSERT_HEAD(&workq, p, pfrke_workq);
395 1.1 itojun xdel++;
396 1.1 itojun }
397 1.1 itojun if (flags & PFR_FLAG_FEEDBACK)
398 1.1 itojun if (COPYOUT(&ad, addr+i, sizeof(ad)))
399 1.1 itojun senderr(EFAULT);
400 1.1 itojun }
401 1.1 itojun if (!(flags & PFR_FLAG_DUMMY)) {
402 1.1 itojun if (flags & PFR_FLAG_ATOMIC)
403 1.1 itojun s = splsoftnet();
404 1.1 itojun pfr_remove_kentries(kt, &workq);
405 1.1 itojun if (flags & PFR_FLAG_ATOMIC)
406 1.1 itojun splx(s);
407 1.1 itojun }
408 1.1 itojun if (ndel != NULL)
409 1.1 itojun *ndel = xdel;
410 1.1 itojun return (0);
411 1.1 itojun _bad:
412 1.1 itojun if (flags & PFR_FLAG_FEEDBACK)
413 1.1 itojun pfr_reset_feedback(addr, size, flags);
414 1.1 itojun return (rv);
415 1.1 itojun }
416 1.1 itojun
417 1.1 itojun int
418 1.1 itojun pfr_set_addrs(struct pfr_table *tbl, struct pfr_addr *addr, int size,
419 1.1 itojun int *size2, int *nadd, int *ndel, int *nchange, int flags)
420 1.1 itojun {
421 1.1 itojun struct pfr_ktable *kt, *tmpkt;
422 1.1 itojun struct pfr_kentryworkq addq, delq, changeq;
423 1.1 itojun struct pfr_kentry *p, *q;
424 1.1 itojun struct pfr_addr ad;
425 1.5 yamt int i, rv, s = 0 /* XXX gcc */, xadd = 0, xdel = 0,
426 1.5 yamt xchange = 0;
427 1.5 yamt long tzero = time_second;
428 1.1 itojun
429 1.1 itojun ACCEPT_FLAGS(PFR_FLAG_ATOMIC+PFR_FLAG_DUMMY+PFR_FLAG_FEEDBACK);
430 1.1 itojun if (pfr_validate_table(tbl, 0, flags & PFR_FLAG_USERIOCTL))
431 1.1 itojun return (EINVAL);
432 1.1 itojun kt = pfr_lookup_table(tbl);
433 1.1 itojun if (kt == NULL || !(kt->pfrkt_flags & PFR_TFLAG_ACTIVE))
434 1.1 itojun return (ESRCH);
435 1.1 itojun if (kt->pfrkt_flags & PFR_TFLAG_CONST)
436 1.1 itojun return (EPERM);
437 1.1 itojun tmpkt = pfr_create_ktable(&pfr_nulltable, 0, 0);
438 1.1 itojun if (tmpkt == NULL)
439 1.1 itojun return (ENOMEM);
440 1.1 itojun pfr_mark_addrs(kt);
441 1.1 itojun SLIST_INIT(&addq);
442 1.1 itojun SLIST_INIT(&delq);
443 1.1 itojun SLIST_INIT(&changeq);
444 1.1 itojun for (i = 0; i < size; i++) {
445 1.1 itojun if (COPYIN(addr+i, &ad, sizeof(ad)))
446 1.1 itojun senderr(EFAULT);
447 1.1 itojun if (pfr_validate_addr(&ad))
448 1.1 itojun senderr(EINVAL);
449 1.1 itojun ad.pfra_fback = PFR_FB_NONE;
450 1.1 itojun p = pfr_lookup_addr(kt, &ad, 1);
451 1.1 itojun if (p != NULL) {
452 1.1 itojun if (p->pfrke_mark) {
453 1.1 itojun ad.pfra_fback = PFR_FB_DUPLICATE;
454 1.1 itojun goto _skip;
455 1.1 itojun }
456 1.1 itojun p->pfrke_mark = 1;
457 1.1 itojun if (p->pfrke_not != ad.pfra_not) {
458 1.1 itojun SLIST_INSERT_HEAD(&changeq, p, pfrke_workq);
459 1.1 itojun ad.pfra_fback = PFR_FB_CHANGED;
460 1.1 itojun xchange++;
461 1.1 itojun }
462 1.1 itojun } else {
463 1.1 itojun q = pfr_lookup_addr(tmpkt, &ad, 1);
464 1.1 itojun if (q != NULL) {
465 1.1 itojun ad.pfra_fback = PFR_FB_DUPLICATE;
466 1.1 itojun goto _skip;
467 1.1 itojun }
468 1.1 itojun p = pfr_create_kentry(&ad);
469 1.1 itojun if (p == NULL)
470 1.1 itojun senderr(ENOMEM);
471 1.1 itojun if (pfr_route_kentry(tmpkt, p)) {
472 1.1 itojun pfr_destroy_kentry(p);
473 1.1 itojun ad.pfra_fback = PFR_FB_NONE;
474 1.1 itojun } else {
475 1.1 itojun SLIST_INSERT_HEAD(&addq, p, pfrke_workq);
476 1.1 itojun ad.pfra_fback = PFR_FB_ADDED;
477 1.1 itojun xadd++;
478 1.1 itojun }
479 1.1 itojun }
480 1.1 itojun _skip:
481 1.1 itojun if (flags & PFR_FLAG_FEEDBACK)
482 1.1 itojun if (COPYOUT(&ad, addr+i, sizeof(ad)))
483 1.1 itojun senderr(EFAULT);
484 1.1 itojun }
485 1.1 itojun pfr_enqueue_addrs(kt, &delq, &xdel, ENQUEUE_UNMARKED_ONLY);
486 1.1 itojun if ((flags & PFR_FLAG_FEEDBACK) && *size2) {
487 1.1 itojun if (*size2 < size+xdel) {
488 1.1 itojun *size2 = size+xdel;
489 1.1 itojun senderr(0);
490 1.1 itojun }
491 1.1 itojun i = 0;
492 1.1 itojun SLIST_FOREACH(p, &delq, pfrke_workq) {
493 1.1 itojun pfr_copyout_addr(&ad, p);
494 1.1 itojun ad.pfra_fback = PFR_FB_DELETED;
495 1.1 itojun if (COPYOUT(&ad, addr+size+i, sizeof(ad)))
496 1.1 itojun senderr(EFAULT);
497 1.1 itojun i++;
498 1.1 itojun }
499 1.1 itojun }
500 1.1 itojun pfr_clean_node_mask(tmpkt, &addq);
501 1.1 itojun if (!(flags & PFR_FLAG_DUMMY)) {
502 1.1 itojun if (flags & PFR_FLAG_ATOMIC)
503 1.1 itojun s = splsoftnet();
504 1.1 itojun pfr_insert_kentries(kt, &addq, tzero);
505 1.1 itojun pfr_remove_kentries(kt, &delq);
506 1.1 itojun pfr_clstats_kentries(&changeq, tzero, INVERT_NEG_FLAG);
507 1.1 itojun if (flags & PFR_FLAG_ATOMIC)
508 1.1 itojun splx(s);
509 1.1 itojun } else
510 1.1 itojun pfr_destroy_kentries(&addq);
511 1.1 itojun if (nadd != NULL)
512 1.1 itojun *nadd = xadd;
513 1.1 itojun if (ndel != NULL)
514 1.1 itojun *ndel = xdel;
515 1.1 itojun if (nchange != NULL)
516 1.1 itojun *nchange = xchange;
517 1.1 itojun if ((flags & PFR_FLAG_FEEDBACK) && size2)
518 1.1 itojun *size2 = size+xdel;
519 1.1 itojun pfr_destroy_ktable(tmpkt, 0);
520 1.1 itojun return (0);
521 1.1 itojun _bad:
522 1.1 itojun pfr_clean_node_mask(tmpkt, &addq);
523 1.1 itojun pfr_destroy_kentries(&addq);
524 1.1 itojun if (flags & PFR_FLAG_FEEDBACK)
525 1.1 itojun pfr_reset_feedback(addr, size, flags);
526 1.1 itojun pfr_destroy_ktable(tmpkt, 0);
527 1.1 itojun return (rv);
528 1.1 itojun }
529 1.1 itojun
530 1.1 itojun int
531 1.1 itojun pfr_tst_addrs(struct pfr_table *tbl, struct pfr_addr *addr, int size,
532 1.1 itojun int *nmatch, int flags)
533 1.1 itojun {
534 1.1 itojun struct pfr_ktable *kt;
535 1.1 itojun struct pfr_kentry *p;
536 1.1 itojun struct pfr_addr ad;
537 1.1 itojun int i, xmatch = 0;
538 1.1 itojun
539 1.1 itojun ACCEPT_FLAGS(PFR_FLAG_REPLACE);
540 1.1 itojun if (pfr_validate_table(tbl, 0, 0))
541 1.1 itojun return (EINVAL);
542 1.1 itojun kt = pfr_lookup_table(tbl);
543 1.1 itojun if (kt == NULL || !(kt->pfrkt_flags & PFR_TFLAG_ACTIVE))
544 1.1 itojun return (ESRCH);
545 1.1 itojun
546 1.1 itojun for (i = 0; i < size; i++) {
547 1.1 itojun if (COPYIN(addr+i, &ad, sizeof(ad)))
548 1.1 itojun return (EFAULT);
549 1.1 itojun if (pfr_validate_addr(&ad))
550 1.1 itojun return (EINVAL);
551 1.1 itojun if (ADDR_NETWORK(&ad))
552 1.1 itojun return (EINVAL);
553 1.1 itojun p = pfr_lookup_addr(kt, &ad, 0);
554 1.1 itojun if (flags & PFR_FLAG_REPLACE)
555 1.1 itojun pfr_copyout_addr(&ad, p);
556 1.1 itojun ad.pfra_fback = (p == NULL) ? PFR_FB_NONE :
557 1.1 itojun (p->pfrke_not ? PFR_FB_NOTMATCH : PFR_FB_MATCH);
558 1.1 itojun if (p != NULL && !p->pfrke_not)
559 1.1 itojun xmatch++;
560 1.1 itojun if (COPYOUT(&ad, addr+i, sizeof(ad)))
561 1.1 itojun return (EFAULT);
562 1.1 itojun }
563 1.1 itojun if (nmatch != NULL)
564 1.1 itojun *nmatch = xmatch;
565 1.1 itojun return (0);
566 1.1 itojun }
567 1.1 itojun
568 1.1 itojun int
569 1.1 itojun pfr_get_addrs(struct pfr_table *tbl, struct pfr_addr *addr, int *size,
570 1.1 itojun int flags)
571 1.1 itojun {
572 1.1 itojun struct pfr_ktable *kt;
573 1.1 itojun struct pfr_walktree w;
574 1.1 itojun int rv;
575 1.1 itojun
576 1.1 itojun ACCEPT_FLAGS(0);
577 1.1 itojun if (pfr_validate_table(tbl, 0, 0))
578 1.1 itojun return (EINVAL);
579 1.1 itojun kt = pfr_lookup_table(tbl);
580 1.1 itojun if (kt == NULL || !(kt->pfrkt_flags & PFR_TFLAG_ACTIVE))
581 1.1 itojun return (ESRCH);
582 1.1 itojun if (kt->pfrkt_cnt > *size) {
583 1.1 itojun *size = kt->pfrkt_cnt;
584 1.1 itojun return (0);
585 1.1 itojun }
586 1.1 itojun
587 1.1 itojun bzero(&w, sizeof(w));
588 1.1 itojun w.pfrw_op = PFRW_GET_ADDRS;
589 1.1 itojun w.pfrw_addr = addr;
590 1.1 itojun w.pfrw_free = kt->pfrkt_cnt;
591 1.1 itojun w.pfrw_flags = flags;
592 1.1 itojun rv = rn_walktree(kt->pfrkt_ip4, pfr_walktree, &w);
593 1.1 itojun if (!rv)
594 1.1 itojun rv = rn_walktree(kt->pfrkt_ip6, pfr_walktree, &w);
595 1.1 itojun if (rv)
596 1.1 itojun return (rv);
597 1.1 itojun
598 1.1 itojun if (w.pfrw_free) {
599 1.1 itojun printf("pfr_get_addrs: corruption detected (%d).\n",
600 1.1 itojun w.pfrw_free);
601 1.1 itojun return (ENOTTY);
602 1.1 itojun }
603 1.1 itojun *size = kt->pfrkt_cnt;
604 1.1 itojun return (0);
605 1.1 itojun }
606 1.1 itojun
607 1.1 itojun int
608 1.1 itojun pfr_get_astats(struct pfr_table *tbl, struct pfr_astats *addr, int *size,
609 1.1 itojun int flags)
610 1.1 itojun {
611 1.1 itojun struct pfr_ktable *kt;
612 1.1 itojun struct pfr_walktree w;
613 1.1 itojun struct pfr_kentryworkq workq;
614 1.5 yamt int rv, s = 0 /* XXX gcc */;
615 1.5 yamt long tzero = time_second;
616 1.1 itojun
617 1.1 itojun ACCEPT_FLAGS(PFR_FLAG_ATOMIC); /* XXX PFR_FLAG_CLSTATS disabled */
618 1.1 itojun if (pfr_validate_table(tbl, 0, 0))
619 1.1 itojun return (EINVAL);
620 1.1 itojun kt = pfr_lookup_table(tbl);
621 1.1 itojun if (kt == NULL || !(kt->pfrkt_flags & PFR_TFLAG_ACTIVE))
622 1.1 itojun return (ESRCH);
623 1.1 itojun if (kt->pfrkt_cnt > *size) {
624 1.1 itojun *size = kt->pfrkt_cnt;
625 1.1 itojun return (0);
626 1.1 itojun }
627 1.1 itojun
628 1.1 itojun bzero(&w, sizeof(w));
629 1.1 itojun w.pfrw_op = PFRW_GET_ASTATS;
630 1.1 itojun w.pfrw_astats = addr;
631 1.1 itojun w.pfrw_free = kt->pfrkt_cnt;
632 1.1 itojun w.pfrw_flags = flags;
633 1.1 itojun if (flags & PFR_FLAG_ATOMIC)
634 1.1 itojun s = splsoftnet();
635 1.1 itojun rv = rn_walktree(kt->pfrkt_ip4, pfr_walktree, &w);
636 1.1 itojun if (!rv)
637 1.1 itojun rv = rn_walktree(kt->pfrkt_ip6, pfr_walktree, &w);
638 1.1 itojun if (!rv && (flags & PFR_FLAG_CLSTATS)) {
639 1.1 itojun pfr_enqueue_addrs(kt, &workq, NULL, 0);
640 1.1 itojun pfr_clstats_kentries(&workq, tzero, 0);
641 1.1 itojun }
642 1.1 itojun if (flags & PFR_FLAG_ATOMIC)
643 1.1 itojun splx(s);
644 1.1 itojun if (rv)
645 1.1 itojun return (rv);
646 1.1 itojun
647 1.1 itojun if (w.pfrw_free) {
648 1.1 itojun printf("pfr_get_astats: corruption detected (%d).\n",
649 1.1 itojun w.pfrw_free);
650 1.1 itojun return (ENOTTY);
651 1.1 itojun }
652 1.1 itojun *size = kt->pfrkt_cnt;
653 1.1 itojun return (0);
654 1.1 itojun }
655 1.1 itojun
656 1.1 itojun int
657 1.1 itojun pfr_clr_astats(struct pfr_table *tbl, struct pfr_addr *addr, int size,
658 1.1 itojun int *nzero, int flags)
659 1.1 itojun {
660 1.1 itojun struct pfr_ktable *kt;
661 1.1 itojun struct pfr_kentryworkq workq;
662 1.1 itojun struct pfr_kentry *p;
663 1.1 itojun struct pfr_addr ad;
664 1.2 itojun int i, rv, s = 0, xzero = 0;
665 1.1 itojun
666 1.1 itojun ACCEPT_FLAGS(PFR_FLAG_ATOMIC+PFR_FLAG_DUMMY+PFR_FLAG_FEEDBACK);
667 1.1 itojun if (pfr_validate_table(tbl, 0, 0))
668 1.1 itojun return (EINVAL);
669 1.1 itojun kt = pfr_lookup_table(tbl);
670 1.1 itojun if (kt == NULL || !(kt->pfrkt_flags & PFR_TFLAG_ACTIVE))
671 1.1 itojun return (ESRCH);
672 1.1 itojun SLIST_INIT(&workq);
673 1.1 itojun for (i = 0; i < size; i++) {
674 1.1 itojun if (COPYIN(addr+i, &ad, sizeof(ad)))
675 1.1 itojun senderr(EFAULT);
676 1.1 itojun if (pfr_validate_addr(&ad))
677 1.1 itojun senderr(EINVAL);
678 1.1 itojun p = pfr_lookup_addr(kt, &ad, 1);
679 1.1 itojun if (flags & PFR_FLAG_FEEDBACK) {
680 1.1 itojun ad.pfra_fback = (p != NULL) ?
681 1.1 itojun PFR_FB_CLEARED : PFR_FB_NONE;
682 1.1 itojun if (COPYOUT(&ad, addr+i, sizeof(ad)))
683 1.1 itojun senderr(EFAULT);
684 1.1 itojun }
685 1.1 itojun if (p != NULL) {
686 1.1 itojun SLIST_INSERT_HEAD(&workq, p, pfrke_workq);
687 1.1 itojun xzero++;
688 1.1 itojun }
689 1.1 itojun }
690 1.1 itojun
691 1.1 itojun if (!(flags & PFR_FLAG_DUMMY)) {
692 1.1 itojun if (flags & PFR_FLAG_ATOMIC)
693 1.1 itojun s = splsoftnet();
694 1.1 itojun pfr_clstats_kentries(&workq, 0, 0);
695 1.1 itojun if (flags & PFR_FLAG_ATOMIC)
696 1.1 itojun splx(s);
697 1.1 itojun }
698 1.1 itojun if (nzero != NULL)
699 1.1 itojun *nzero = xzero;
700 1.1 itojun return (0);
701 1.1 itojun _bad:
702 1.1 itojun if (flags & PFR_FLAG_FEEDBACK)
703 1.1 itojun pfr_reset_feedback(addr, size, flags);
704 1.1 itojun return (rv);
705 1.1 itojun }
706 1.1 itojun
707 1.1 itojun int
708 1.1 itojun pfr_validate_addr(struct pfr_addr *ad)
709 1.1 itojun {
710 1.1 itojun int i;
711 1.1 itojun
712 1.1 itojun switch (ad->pfra_af) {
713 1.5 yamt #ifdef INET
714 1.1 itojun case AF_INET:
715 1.1 itojun if (ad->pfra_net > 32)
716 1.1 itojun return (-1);
717 1.1 itojun break;
718 1.5 yamt #endif /* INET */
719 1.5 yamt #ifdef INET6
720 1.1 itojun case AF_INET6:
721 1.1 itojun if (ad->pfra_net > 128)
722 1.1 itojun return (-1);
723 1.1 itojun break;
724 1.5 yamt #endif /* INET6 */
725 1.1 itojun default:
726 1.1 itojun return (-1);
727 1.1 itojun }
728 1.1 itojun if (ad->pfra_net < 128 &&
729 1.1 itojun (((caddr_t)ad)[ad->pfra_net/8] & (0xFF >> (ad->pfra_net%8))))
730 1.1 itojun return (-1);
731 1.1 itojun for (i = (ad->pfra_net+7)/8; i < sizeof(ad->pfra_u); i++)
732 1.1 itojun if (((caddr_t)ad)[i])
733 1.1 itojun return (-1);
734 1.1 itojun if (ad->pfra_not && ad->pfra_not != 1)
735 1.1 itojun return (-1);
736 1.1 itojun if (ad->pfra_fback)
737 1.1 itojun return (-1);
738 1.1 itojun return (0);
739 1.1 itojun }
740 1.1 itojun
741 1.1 itojun void
742 1.1 itojun pfr_enqueue_addrs(struct pfr_ktable *kt, struct pfr_kentryworkq *workq,
743 1.1 itojun int *naddr, int sweep)
744 1.1 itojun {
745 1.1 itojun struct pfr_walktree w;
746 1.1 itojun
747 1.1 itojun SLIST_INIT(workq);
748 1.1 itojun bzero(&w, sizeof(w));
749 1.1 itojun w.pfrw_op = sweep ? PFRW_SWEEP : PFRW_ENQUEUE;
750 1.1 itojun w.pfrw_workq = workq;
751 1.1 itojun if (kt->pfrkt_ip4 != NULL)
752 1.1 itojun if (rn_walktree(kt->pfrkt_ip4, pfr_walktree, &w))
753 1.1 itojun printf("pfr_enqueue_addrs: IPv4 walktree failed.\n");
754 1.1 itojun if (kt->pfrkt_ip6 != NULL)
755 1.1 itojun if (rn_walktree(kt->pfrkt_ip6, pfr_walktree, &w))
756 1.1 itojun printf("pfr_enqueue_addrs: IPv6 walktree failed.\n");
757 1.1 itojun if (naddr != NULL)
758 1.1 itojun *naddr = w.pfrw_cnt;
759 1.1 itojun }
760 1.1 itojun
761 1.1 itojun void
762 1.1 itojun pfr_mark_addrs(struct pfr_ktable *kt)
763 1.1 itojun {
764 1.1 itojun struct pfr_walktree w;
765 1.1 itojun
766 1.1 itojun bzero(&w, sizeof(w));
767 1.1 itojun w.pfrw_op = PFRW_MARK;
768 1.1 itojun if (rn_walktree(kt->pfrkt_ip4, pfr_walktree, &w))
769 1.1 itojun printf("pfr_mark_addrs: IPv4 walktree failed.\n");
770 1.1 itojun if (rn_walktree(kt->pfrkt_ip6, pfr_walktree, &w))
771 1.1 itojun printf("pfr_mark_addrs: IPv6 walktree failed.\n");
772 1.1 itojun }
773 1.1 itojun
774 1.1 itojun
775 1.1 itojun struct pfr_kentry *
776 1.1 itojun pfr_lookup_addr(struct pfr_ktable *kt, struct pfr_addr *ad, int exact)
777 1.1 itojun {
778 1.1 itojun union sockaddr_union sa, mask;
779 1.5 yamt struct radix_node_head *head = (void *)0xdeadb;
780 1.1 itojun struct pfr_kentry *ke;
781 1.1 itojun int s;
782 1.1 itojun
783 1.1 itojun bzero(&sa, sizeof(sa));
784 1.1 itojun if (ad->pfra_af == AF_INET) {
785 1.1 itojun FILLIN_SIN(sa.sin, ad->pfra_ip4addr);
786 1.1 itojun head = kt->pfrkt_ip4;
787 1.5 yamt } else if ( ad->pfra_af == AF_INET6 ) {
788 1.1 itojun FILLIN_SIN6(sa.sin6, ad->pfra_ip6addr);
789 1.1 itojun head = kt->pfrkt_ip6;
790 1.1 itojun }
791 1.1 itojun if (ADDR_NETWORK(ad)) {
792 1.1 itojun pfr_prepare_network(&mask, ad->pfra_af, ad->pfra_net);
793 1.1 itojun s = splsoftnet(); /* rn_lookup makes use of globals */
794 1.1 itojun ke = (struct pfr_kentry *)rn_lookup(&sa, &mask, head);
795 1.1 itojun splx(s);
796 1.1 itojun if (ke && KENTRY_RNF_ROOT(ke))
797 1.1 itojun ke = NULL;
798 1.1 itojun } else {
799 1.1 itojun ke = (struct pfr_kentry *)rn_match(&sa, head);
800 1.1 itojun if (ke && KENTRY_RNF_ROOT(ke))
801 1.1 itojun ke = NULL;
802 1.1 itojun if (exact && ke && KENTRY_NETWORK(ke))
803 1.1 itojun ke = NULL;
804 1.1 itojun }
805 1.1 itojun return (ke);
806 1.1 itojun }
807 1.1 itojun
808 1.1 itojun struct pfr_kentry *
809 1.1 itojun pfr_create_kentry(struct pfr_addr *ad)
810 1.1 itojun {
811 1.1 itojun struct pfr_kentry *ke;
812 1.1 itojun
813 1.1 itojun ke = pool_get(&pfr_kentry_pl, PR_NOWAIT);
814 1.1 itojun if (ke == NULL)
815 1.1 itojun return (NULL);
816 1.1 itojun bzero(ke, sizeof(*ke));
817 1.1 itojun
818 1.1 itojun if (ad->pfra_af == AF_INET)
819 1.1 itojun FILLIN_SIN(ke->pfrke_sa.sin, ad->pfra_ip4addr);
820 1.5 yamt else if (ad->pfra_af == AF_INET6)
821 1.1 itojun FILLIN_SIN6(ke->pfrke_sa.sin6, ad->pfra_ip6addr);
822 1.1 itojun ke->pfrke_af = ad->pfra_af;
823 1.1 itojun ke->pfrke_net = ad->pfra_net;
824 1.1 itojun ke->pfrke_not = ad->pfra_not;
825 1.1 itojun return (ke);
826 1.1 itojun }
827 1.1 itojun
828 1.1 itojun void
829 1.1 itojun pfr_destroy_kentries(struct pfr_kentryworkq *workq)
830 1.1 itojun {
831 1.1 itojun struct pfr_kentry *p, *q;
832 1.1 itojun
833 1.1 itojun for (p = SLIST_FIRST(workq); p != NULL; p = q) {
834 1.1 itojun q = SLIST_NEXT(p, pfrke_workq);
835 1.1 itojun pfr_destroy_kentry(p);
836 1.1 itojun }
837 1.1 itojun }
838 1.1 itojun
839 1.1 itojun void
840 1.1 itojun pfr_destroy_kentry(struct pfr_kentry *ke)
841 1.1 itojun {
842 1.1 itojun pool_put(&pfr_kentry_pl, ke);
843 1.1 itojun }
844 1.1 itojun
845 1.1 itojun void
846 1.1 itojun pfr_insert_kentries(struct pfr_ktable *kt,
847 1.1 itojun struct pfr_kentryworkq *workq, long tzero)
848 1.1 itojun {
849 1.1 itojun struct pfr_kentry *p;
850 1.1 itojun int rv, n = 0;
851 1.1 itojun
852 1.1 itojun SLIST_FOREACH(p, workq, pfrke_workq) {
853 1.1 itojun rv = pfr_route_kentry(kt, p);
854 1.1 itojun if (rv) {
855 1.1 itojun printf("pfr_insert_kentries: cannot route entry "
856 1.1 itojun "(code=%d).\n", rv);
857 1.1 itojun break;
858 1.1 itojun }
859 1.1 itojun p->pfrke_tzero = tzero;
860 1.1 itojun n++;
861 1.1 itojun }
862 1.1 itojun kt->pfrkt_cnt += n;
863 1.1 itojun }
864 1.1 itojun
865 1.1 itojun void
866 1.1 itojun pfr_remove_kentries(struct pfr_ktable *kt,
867 1.1 itojun struct pfr_kentryworkq *workq)
868 1.1 itojun {
869 1.1 itojun struct pfr_kentry *p;
870 1.1 itojun int n = 0;
871 1.1 itojun
872 1.1 itojun SLIST_FOREACH(p, workq, pfrke_workq) {
873 1.1 itojun pfr_unroute_kentry(kt, p);
874 1.1 itojun n++;
875 1.1 itojun }
876 1.1 itojun kt->pfrkt_cnt -= n;
877 1.1 itojun pfr_destroy_kentries(workq);
878 1.1 itojun }
879 1.1 itojun
880 1.1 itojun void
881 1.1 itojun pfr_clean_node_mask(struct pfr_ktable *kt,
882 1.1 itojun struct pfr_kentryworkq *workq)
883 1.1 itojun {
884 1.1 itojun struct pfr_kentry *p;
885 1.1 itojun
886 1.1 itojun SLIST_FOREACH(p, workq, pfrke_workq)
887 1.1 itojun pfr_unroute_kentry(kt, p);
888 1.1 itojun }
889 1.1 itojun
890 1.1 itojun void
891 1.1 itojun pfr_clstats_kentries(struct pfr_kentryworkq *workq, long tzero, int negchange)
892 1.1 itojun {
893 1.1 itojun struct pfr_kentry *p;
894 1.1 itojun int s;
895 1.1 itojun
896 1.1 itojun SLIST_FOREACH(p, workq, pfrke_workq) {
897 1.1 itojun s = splsoftnet();
898 1.1 itojun if (negchange)
899 1.1 itojun p->pfrke_not = !p->pfrke_not;
900 1.1 itojun bzero(p->pfrke_packets, sizeof(p->pfrke_packets));
901 1.1 itojun bzero(p->pfrke_bytes, sizeof(p->pfrke_bytes));
902 1.1 itojun splx(s);
903 1.1 itojun p->pfrke_tzero = tzero;
904 1.1 itojun }
905 1.1 itojun }
906 1.1 itojun
907 1.1 itojun void
908 1.1 itojun pfr_reset_feedback(struct pfr_addr *addr, int size, int flags)
909 1.1 itojun {
910 1.1 itojun struct pfr_addr ad;
911 1.1 itojun int i;
912 1.1 itojun
913 1.1 itojun for (i = 0; i < size; i++) {
914 1.1 itojun if (COPYIN(addr+i, &ad, sizeof(ad)))
915 1.1 itojun break;
916 1.1 itojun ad.pfra_fback = PFR_FB_NONE;
917 1.1 itojun if (COPYOUT(&ad, addr+i, sizeof(ad)))
918 1.1 itojun break;
919 1.1 itojun }
920 1.1 itojun }
921 1.1 itojun
922 1.1 itojun void
923 1.1 itojun pfr_prepare_network(union sockaddr_union *sa, int af, int net)
924 1.1 itojun {
925 1.1 itojun int i;
926 1.1 itojun
927 1.1 itojun bzero(sa, sizeof(*sa));
928 1.1 itojun if (af == AF_INET) {
929 1.1 itojun sa->sin.sin_len = sizeof(sa->sin);
930 1.1 itojun sa->sin.sin_family = AF_INET;
931 1.5 yamt sa->sin.sin_addr.s_addr = net ? htonl(-1 << (32-net)) : 0;
932 1.5 yamt } else if (af == AF_INET6) {
933 1.1 itojun sa->sin6.sin6_len = sizeof(sa->sin6);
934 1.1 itojun sa->sin6.sin6_family = AF_INET6;
935 1.1 itojun for (i = 0; i < 4; i++) {
936 1.1 itojun if (net <= 32) {
937 1.1 itojun sa->sin6.sin6_addr.s6_addr32[i] =
938 1.5 yamt net ? htonl(-1 << (32-net)) : 0;
939 1.1 itojun break;
940 1.1 itojun }
941 1.1 itojun sa->sin6.sin6_addr.s6_addr32[i] = 0xFFFFFFFF;
942 1.1 itojun net -= 32;
943 1.1 itojun }
944 1.1 itojun }
945 1.1 itojun }
946 1.1 itojun
947 1.1 itojun int
948 1.1 itojun pfr_route_kentry(struct pfr_ktable *kt, struct pfr_kentry *ke)
949 1.1 itojun {
950 1.1 itojun union sockaddr_union mask;
951 1.1 itojun struct radix_node *rn;
952 1.5 yamt struct radix_node_head *head = (void *)0xdeadb;
953 1.1 itojun int s;
954 1.1 itojun
955 1.1 itojun bzero(ke->pfrke_node, sizeof(ke->pfrke_node));
956 1.1 itojun if (ke->pfrke_af == AF_INET)
957 1.1 itojun head = kt->pfrkt_ip4;
958 1.5 yamt else if (ke->pfrke_af == AF_INET6)
959 1.1 itojun head = kt->pfrkt_ip6;
960 1.1 itojun
961 1.1 itojun s = splsoftnet();
962 1.1 itojun if (KENTRY_NETWORK(ke)) {
963 1.1 itojun pfr_prepare_network(&mask, ke->pfrke_af, ke->pfrke_net);
964 1.1 itojun rn = rn_addroute(&ke->pfrke_sa, &mask, head, ke->pfrke_node);
965 1.1 itojun } else
966 1.1 itojun rn = rn_addroute(&ke->pfrke_sa, NULL, head, ke->pfrke_node);
967 1.1 itojun splx(s);
968 1.1 itojun
969 1.1 itojun return (rn == NULL ? -1 : 0);
970 1.1 itojun }
971 1.1 itojun
972 1.1 itojun int
973 1.1 itojun pfr_unroute_kentry(struct pfr_ktable *kt, struct pfr_kentry *ke)
974 1.1 itojun {
975 1.1 itojun union sockaddr_union mask;
976 1.1 itojun struct radix_node *rn;
977 1.5 yamt struct radix_node_head *head = (void *)0xdeadb;
978 1.1 itojun int s;
979 1.1 itojun
980 1.1 itojun if (ke->pfrke_af == AF_INET)
981 1.1 itojun head = kt->pfrkt_ip4;
982 1.5 yamt else if (ke->pfrke_af == AF_INET6)
983 1.1 itojun head = kt->pfrkt_ip6;
984 1.1 itojun
985 1.1 itojun s = splsoftnet();
986 1.1 itojun if (KENTRY_NETWORK(ke)) {
987 1.1 itojun pfr_prepare_network(&mask, ke->pfrke_af, ke->pfrke_net);
988 1.5 yamt #ifdef __OpenBSD__
989 1.5 yamt rn = rn_delete(&ke->pfrke_sa, &mask, head, NULL);
990 1.5 yamt #else
991 1.1 itojun rn = rn_delete(&ke->pfrke_sa, &mask, head);
992 1.5 yamt #endif
993 1.1 itojun } else
994 1.5 yamt #ifdef __OpenBSD__
995 1.5 yamt rn = rn_delete(&ke->pfrke_sa, NULL, head, NULL);
996 1.5 yamt #else
997 1.1 itojun rn = rn_delete(&ke->pfrke_sa, NULL, head);
998 1.5 yamt #endif
999 1.1 itojun splx(s);
1000 1.1 itojun
1001 1.1 itojun if (rn == NULL) {
1002 1.1 itojun printf("pfr_unroute_kentry: delete failed.\n");
1003 1.1 itojun return (-1);
1004 1.1 itojun }
1005 1.1 itojun return (0);
1006 1.1 itojun }
1007 1.1 itojun
1008 1.1 itojun void
1009 1.1 itojun pfr_copyout_addr(struct pfr_addr *ad, struct pfr_kentry *ke)
1010 1.1 itojun {
1011 1.1 itojun bzero(ad, sizeof(*ad));
1012 1.1 itojun if (ke == NULL)
1013 1.1 itojun return;
1014 1.1 itojun ad->pfra_af = ke->pfrke_af;
1015 1.1 itojun ad->pfra_net = ke->pfrke_net;
1016 1.1 itojun ad->pfra_not = ke->pfrke_not;
1017 1.1 itojun if (ad->pfra_af == AF_INET)
1018 1.1 itojun ad->pfra_ip4addr = ke->pfrke_sa.sin.sin_addr;
1019 1.5 yamt else if (ad->pfra_af == AF_INET6)
1020 1.1 itojun ad->pfra_ip6addr = ke->pfrke_sa.sin6.sin6_addr;
1021 1.1 itojun }
1022 1.1 itojun
1023 1.1 itojun int
1024 1.1 itojun pfr_walktree(struct radix_node *rn, void *arg)
1025 1.1 itojun {
1026 1.1 itojun struct pfr_kentry *ke = (struct pfr_kentry *)rn;
1027 1.1 itojun struct pfr_walktree *w = arg;
1028 1.1 itojun int s, flags = w->pfrw_flags;
1029 1.1 itojun
1030 1.1 itojun switch (w->pfrw_op) {
1031 1.1 itojun case PFRW_MARK:
1032 1.1 itojun ke->pfrke_mark = 0;
1033 1.1 itojun break;
1034 1.1 itojun case PFRW_SWEEP:
1035 1.1 itojun if (ke->pfrke_mark)
1036 1.1 itojun break;
1037 1.1 itojun /* FALLTHROUGH */
1038 1.1 itojun case PFRW_ENQUEUE:
1039 1.1 itojun SLIST_INSERT_HEAD(w->pfrw_workq, ke, pfrke_workq);
1040 1.1 itojun w->pfrw_cnt++;
1041 1.1 itojun break;
1042 1.1 itojun case PFRW_GET_ADDRS:
1043 1.1 itojun if (w->pfrw_free-- > 0) {
1044 1.1 itojun struct pfr_addr ad;
1045 1.1 itojun
1046 1.1 itojun pfr_copyout_addr(&ad, ke);
1047 1.1 itojun if (copyout(&ad, w->pfrw_addr, sizeof(ad)))
1048 1.1 itojun return (EFAULT);
1049 1.1 itojun w->pfrw_addr++;
1050 1.1 itojun }
1051 1.1 itojun break;
1052 1.1 itojun case PFRW_GET_ASTATS:
1053 1.1 itojun if (w->pfrw_free-- > 0) {
1054 1.1 itojun struct pfr_astats as;
1055 1.1 itojun
1056 1.1 itojun pfr_copyout_addr(&as.pfras_a, ke);
1057 1.1 itojun
1058 1.1 itojun s = splsoftnet();
1059 1.1 itojun bcopy(ke->pfrke_packets, as.pfras_packets,
1060 1.1 itojun sizeof(as.pfras_packets));
1061 1.1 itojun bcopy(ke->pfrke_bytes, as.pfras_bytes,
1062 1.1 itojun sizeof(as.pfras_bytes));
1063 1.1 itojun splx(s);
1064 1.1 itojun as.pfras_tzero = ke->pfrke_tzero;
1065 1.1 itojun
1066 1.1 itojun if (COPYOUT(&as, w->pfrw_astats, sizeof(as)))
1067 1.1 itojun return (EFAULT);
1068 1.1 itojun w->pfrw_astats++;
1069 1.1 itojun }
1070 1.1 itojun break;
1071 1.1 itojun case PFRW_POOL_GET:
1072 1.1 itojun if (ke->pfrke_not)
1073 1.1 itojun break; /* negative entries are ignored */
1074 1.1 itojun if (!w->pfrw_cnt--) {
1075 1.1 itojun w->pfrw_kentry = ke;
1076 1.1 itojun return (1); /* finish search */
1077 1.1 itojun }
1078 1.1 itojun break;
1079 1.1 itojun case PFRW_DYNADDR_UPDATE:
1080 1.1 itojun if (ke->pfrke_af == AF_INET) {
1081 1.1 itojun if (w->pfrw_dyn->pfid_acnt4++ > 0)
1082 1.1 itojun break;
1083 1.1 itojun pfr_prepare_network(&pfr_mask, AF_INET, ke->pfrke_net);
1084 1.1 itojun w->pfrw_dyn->pfid_addr4 = *SUNION2PF(
1085 1.1 itojun &ke->pfrke_sa, AF_INET);
1086 1.1 itojun w->pfrw_dyn->pfid_mask4 = *SUNION2PF(
1087 1.1 itojun &pfr_mask, AF_INET);
1088 1.5 yamt } else if (ke->pfrke_af == AF_INET6){
1089 1.1 itojun if (w->pfrw_dyn->pfid_acnt6++ > 0)
1090 1.1 itojun break;
1091 1.1 itojun pfr_prepare_network(&pfr_mask, AF_INET6, ke->pfrke_net);
1092 1.1 itojun w->pfrw_dyn->pfid_addr6 = *SUNION2PF(
1093 1.1 itojun &ke->pfrke_sa, AF_INET6);
1094 1.1 itojun w->pfrw_dyn->pfid_mask6 = *SUNION2PF(
1095 1.1 itojun &pfr_mask, AF_INET6);
1096 1.1 itojun }
1097 1.1 itojun break;
1098 1.1 itojun }
1099 1.1 itojun return (0);
1100 1.1 itojun }
1101 1.1 itojun
1102 1.1 itojun int
1103 1.1 itojun pfr_clr_tables(struct pfr_table *filter, int *ndel, int flags)
1104 1.1 itojun {
1105 1.1 itojun struct pfr_ktableworkq workq;
1106 1.1 itojun struct pfr_ktable *p;
1107 1.2 itojun int s = 0, xdel = 0;
1108 1.1 itojun
1109 1.1 itojun ACCEPT_FLAGS(PFR_FLAG_ATOMIC+PFR_FLAG_DUMMY+PFR_FLAG_ALLRSETS);
1110 1.1 itojun if (pfr_table_count(filter, flags) < 0)
1111 1.1 itojun return (ENOENT);
1112 1.1 itojun
1113 1.1 itojun SLIST_INIT(&workq);
1114 1.1 itojun RB_FOREACH(p, pfr_ktablehead, &pfr_ktables) {
1115 1.1 itojun if (pfr_skip_table(filter, p, flags))
1116 1.1 itojun continue;
1117 1.1 itojun if (!strcmp(p->pfrkt_anchor, PF_RESERVED_ANCHOR))
1118 1.1 itojun continue;
1119 1.1 itojun if (!(p->pfrkt_flags & PFR_TFLAG_ACTIVE))
1120 1.1 itojun continue;
1121 1.1 itojun p->pfrkt_nflags = p->pfrkt_flags & ~PFR_TFLAG_ACTIVE;
1122 1.1 itojun SLIST_INSERT_HEAD(&workq, p, pfrkt_workq);
1123 1.1 itojun xdel++;
1124 1.1 itojun }
1125 1.1 itojun if (!(flags & PFR_FLAG_DUMMY)) {
1126 1.1 itojun if (flags & PFR_FLAG_ATOMIC)
1127 1.1 itojun s = splsoftnet();
1128 1.1 itojun pfr_setflags_ktables(&workq);
1129 1.1 itojun if (flags & PFR_FLAG_ATOMIC)
1130 1.1 itojun splx(s);
1131 1.1 itojun }
1132 1.1 itojun if (ndel != NULL)
1133 1.1 itojun *ndel = xdel;
1134 1.1 itojun return (0);
1135 1.1 itojun }
1136 1.1 itojun
1137 1.1 itojun int
1138 1.1 itojun pfr_add_tables(struct pfr_table *tbl, int size, int *nadd, int flags)
1139 1.1 itojun {
1140 1.1 itojun struct pfr_ktableworkq addq, changeq;
1141 1.1 itojun struct pfr_ktable *p, *q, *r, key;
1142 1.5 yamt int i, rv, s = 0 /* XXX gcc */, xadd = 0;
1143 1.5 yamt long tzero = time_second;
1144 1.1 itojun
1145 1.1 itojun ACCEPT_FLAGS(PFR_FLAG_ATOMIC+PFR_FLAG_DUMMY);
1146 1.1 itojun SLIST_INIT(&addq);
1147 1.1 itojun SLIST_INIT(&changeq);
1148 1.1 itojun for (i = 0; i < size; i++) {
1149 1.1 itojun if (COPYIN(tbl+i, &key.pfrkt_t, sizeof(key.pfrkt_t)))
1150 1.1 itojun senderr(EFAULT);
1151 1.1 itojun if (pfr_validate_table(&key.pfrkt_t, PFR_TFLAG_USRMASK,
1152 1.1 itojun flags & PFR_FLAG_USERIOCTL))
1153 1.1 itojun senderr(EINVAL);
1154 1.1 itojun key.pfrkt_flags |= PFR_TFLAG_ACTIVE;
1155 1.1 itojun p = RB_FIND(pfr_ktablehead, &pfr_ktables, &key);
1156 1.1 itojun if (p == NULL) {
1157 1.1 itojun p = pfr_create_ktable(&key.pfrkt_t, tzero, 1);
1158 1.1 itojun if (p == NULL)
1159 1.1 itojun senderr(ENOMEM);
1160 1.1 itojun SLIST_FOREACH(q, &addq, pfrkt_workq) {
1161 1.1 itojun if (!pfr_ktable_compare(p, q))
1162 1.1 itojun goto _skip;
1163 1.1 itojun }
1164 1.1 itojun SLIST_INSERT_HEAD(&addq, p, pfrkt_workq);
1165 1.1 itojun xadd++;
1166 1.1 itojun if (!key.pfrkt_anchor[0])
1167 1.1 itojun goto _skip;
1168 1.1 itojun
1169 1.1 itojun /* find or create root table */
1170 1.1 itojun bzero(key.pfrkt_anchor, sizeof(key.pfrkt_anchor));
1171 1.1 itojun r = RB_FIND(pfr_ktablehead, &pfr_ktables, &key);
1172 1.1 itojun if (r != NULL) {
1173 1.1 itojun p->pfrkt_root = r;
1174 1.1 itojun goto _skip;
1175 1.1 itojun }
1176 1.1 itojun SLIST_FOREACH(q, &addq, pfrkt_workq) {
1177 1.1 itojun if (!pfr_ktable_compare(&key, q)) {
1178 1.1 itojun p->pfrkt_root = q;
1179 1.1 itojun goto _skip;
1180 1.1 itojun }
1181 1.1 itojun }
1182 1.1 itojun key.pfrkt_flags = 0;
1183 1.1 itojun r = pfr_create_ktable(&key.pfrkt_t, 0, 1);
1184 1.1 itojun if (r == NULL)
1185 1.1 itojun senderr(ENOMEM);
1186 1.1 itojun SLIST_INSERT_HEAD(&addq, r, pfrkt_workq);
1187 1.1 itojun p->pfrkt_root = r;
1188 1.1 itojun } else if (!(p->pfrkt_flags & PFR_TFLAG_ACTIVE)) {
1189 1.1 itojun SLIST_FOREACH(q, &changeq, pfrkt_workq)
1190 1.1 itojun if (!pfr_ktable_compare(&key, q))
1191 1.1 itojun goto _skip;
1192 1.1 itojun p->pfrkt_nflags = (p->pfrkt_flags &
1193 1.1 itojun ~PFR_TFLAG_USRMASK) | key.pfrkt_flags;
1194 1.1 itojun SLIST_INSERT_HEAD(&changeq, p, pfrkt_workq);
1195 1.1 itojun xadd++;
1196 1.1 itojun }
1197 1.1 itojun _skip:
1198 1.1 itojun ;
1199 1.1 itojun }
1200 1.1 itojun if (!(flags & PFR_FLAG_DUMMY)) {
1201 1.1 itojun if (flags & PFR_FLAG_ATOMIC)
1202 1.1 itojun s = splsoftnet();
1203 1.1 itojun pfr_insert_ktables(&addq);
1204 1.1 itojun pfr_setflags_ktables(&changeq);
1205 1.1 itojun if (flags & PFR_FLAG_ATOMIC)
1206 1.1 itojun splx(s);
1207 1.1 itojun } else
1208 1.1 itojun pfr_destroy_ktables(&addq, 0);
1209 1.1 itojun if (nadd != NULL)
1210 1.1 itojun *nadd = xadd;
1211 1.1 itojun return (0);
1212 1.1 itojun _bad:
1213 1.1 itojun pfr_destroy_ktables(&addq, 0);
1214 1.1 itojun return (rv);
1215 1.1 itojun }
1216 1.1 itojun
1217 1.1 itojun int
1218 1.1 itojun pfr_del_tables(struct pfr_table *tbl, int size, int *ndel, int flags)
1219 1.1 itojun {
1220 1.1 itojun struct pfr_ktableworkq workq;
1221 1.1 itojun struct pfr_ktable *p, *q, key;
1222 1.2 itojun int i, s = 0, xdel = 0;
1223 1.1 itojun
1224 1.1 itojun ACCEPT_FLAGS(PFR_FLAG_ATOMIC+PFR_FLAG_DUMMY);
1225 1.1 itojun SLIST_INIT(&workq);
1226 1.1 itojun for (i = 0; i < size; i++) {
1227 1.1 itojun if (COPYIN(tbl+i, &key.pfrkt_t, sizeof(key.pfrkt_t)))
1228 1.1 itojun return (EFAULT);
1229 1.1 itojun if (pfr_validate_table(&key.pfrkt_t, 0,
1230 1.1 itojun flags & PFR_FLAG_USERIOCTL))
1231 1.1 itojun return (EINVAL);
1232 1.1 itojun p = RB_FIND(pfr_ktablehead, &pfr_ktables, &key);
1233 1.1 itojun if (p != NULL && (p->pfrkt_flags & PFR_TFLAG_ACTIVE)) {
1234 1.1 itojun SLIST_FOREACH(q, &workq, pfrkt_workq)
1235 1.1 itojun if (!pfr_ktable_compare(p, q))
1236 1.1 itojun goto _skip;
1237 1.1 itojun p->pfrkt_nflags = p->pfrkt_flags & ~PFR_TFLAG_ACTIVE;
1238 1.1 itojun SLIST_INSERT_HEAD(&workq, p, pfrkt_workq);
1239 1.1 itojun xdel++;
1240 1.1 itojun }
1241 1.1 itojun _skip:
1242 1.1 itojun ;
1243 1.1 itojun }
1244 1.1 itojun
1245 1.1 itojun if (!(flags & PFR_FLAG_DUMMY)) {
1246 1.1 itojun if (flags & PFR_FLAG_ATOMIC)
1247 1.1 itojun s = splsoftnet();
1248 1.1 itojun pfr_setflags_ktables(&workq);
1249 1.1 itojun if (flags & PFR_FLAG_ATOMIC)
1250 1.1 itojun splx(s);
1251 1.1 itojun }
1252 1.1 itojun if (ndel != NULL)
1253 1.1 itojun *ndel = xdel;
1254 1.1 itojun return (0);
1255 1.1 itojun }
1256 1.1 itojun
1257 1.1 itojun int
1258 1.1 itojun pfr_get_tables(struct pfr_table *filter, struct pfr_table *tbl, int *size,
1259 1.1 itojun int flags)
1260 1.1 itojun {
1261 1.1 itojun struct pfr_ktable *p;
1262 1.1 itojun int n, nn;
1263 1.1 itojun
1264 1.1 itojun ACCEPT_FLAGS(PFR_FLAG_ALLRSETS);
1265 1.1 itojun n = nn = pfr_table_count(filter, flags);
1266 1.1 itojun if (n < 0)
1267 1.1 itojun return (ENOENT);
1268 1.1 itojun if (n > *size) {
1269 1.1 itojun *size = n;
1270 1.1 itojun return (0);
1271 1.1 itojun }
1272 1.1 itojun RB_FOREACH(p, pfr_ktablehead, &pfr_ktables) {
1273 1.1 itojun if (pfr_skip_table(filter, p, flags))
1274 1.1 itojun continue;
1275 1.1 itojun if (n-- <= 0)
1276 1.1 itojun continue;
1277 1.1 itojun if (COPYOUT(&p->pfrkt_t, tbl++, sizeof(*tbl)))
1278 1.1 itojun return (EFAULT);
1279 1.1 itojun }
1280 1.1 itojun if (n) {
1281 1.1 itojun printf("pfr_get_tables: corruption detected (%d).\n", n);
1282 1.1 itojun return (ENOTTY);
1283 1.1 itojun }
1284 1.1 itojun *size = nn;
1285 1.1 itojun return (0);
1286 1.1 itojun }
1287 1.1 itojun
1288 1.1 itojun int
1289 1.1 itojun pfr_get_tstats(struct pfr_table *filter, struct pfr_tstats *tbl, int *size,
1290 1.1 itojun int flags)
1291 1.1 itojun {
1292 1.1 itojun struct pfr_ktable *p;
1293 1.1 itojun struct pfr_ktableworkq workq;
1294 1.5 yamt int s = 0 /* XXX gcc */, n, nn;
1295 1.5 yamt long tzero = time_second;
1296 1.1 itojun
1297 1.1 itojun ACCEPT_FLAGS(PFR_FLAG_ATOMIC|PFR_FLAG_ALLRSETS);
1298 1.1 itojun /* XXX PFR_FLAG_CLSTATS disabled */
1299 1.1 itojun n = nn = pfr_table_count(filter, flags);
1300 1.1 itojun if (n < 0)
1301 1.1 itojun return (ENOENT);
1302 1.1 itojun if (n > *size) {
1303 1.1 itojun *size = n;
1304 1.1 itojun return (0);
1305 1.1 itojun }
1306 1.1 itojun SLIST_INIT(&workq);
1307 1.1 itojun if (flags & PFR_FLAG_ATOMIC)
1308 1.1 itojun s = splsoftnet();
1309 1.1 itojun RB_FOREACH(p, pfr_ktablehead, &pfr_ktables) {
1310 1.1 itojun if (pfr_skip_table(filter, p, flags))
1311 1.1 itojun continue;
1312 1.1 itojun if (n-- <= 0)
1313 1.1 itojun continue;
1314 1.1 itojun if (!(flags & PFR_FLAG_ATOMIC))
1315 1.1 itojun s = splsoftnet();
1316 1.1 itojun if (COPYOUT(&p->pfrkt_ts, tbl++, sizeof(*tbl))) {
1317 1.1 itojun splx(s);
1318 1.1 itojun return (EFAULT);
1319 1.1 itojun }
1320 1.1 itojun if (!(flags & PFR_FLAG_ATOMIC))
1321 1.1 itojun splx(s);
1322 1.1 itojun SLIST_INSERT_HEAD(&workq, p, pfrkt_workq);
1323 1.1 itojun }
1324 1.1 itojun if (flags & PFR_FLAG_CLSTATS)
1325 1.1 itojun pfr_clstats_ktables(&workq, tzero,
1326 1.1 itojun flags & PFR_FLAG_ADDRSTOO);
1327 1.1 itojun if (flags & PFR_FLAG_ATOMIC)
1328 1.1 itojun splx(s);
1329 1.1 itojun if (n) {
1330 1.1 itojun printf("pfr_get_tstats: corruption detected (%d).\n", n);
1331 1.1 itojun return (ENOTTY);
1332 1.1 itojun }
1333 1.1 itojun *size = nn;
1334 1.1 itojun return (0);
1335 1.1 itojun }
1336 1.1 itojun
1337 1.1 itojun int
1338 1.1 itojun pfr_clr_tstats(struct pfr_table *tbl, int size, int *nzero, int flags)
1339 1.1 itojun {
1340 1.1 itojun struct pfr_ktableworkq workq;
1341 1.1 itojun struct pfr_ktable *p, key;
1342 1.5 yamt int i, s = 0 /* XXX gcc */, xzero = 0;
1343 1.5 yamt long tzero = time_second;
1344 1.1 itojun
1345 1.1 itojun ACCEPT_FLAGS(PFR_FLAG_ATOMIC+PFR_FLAG_DUMMY+PFR_FLAG_ADDRSTOO);
1346 1.1 itojun SLIST_INIT(&workq);
1347 1.1 itojun for (i = 0; i < size; i++) {
1348 1.1 itojun if (COPYIN(tbl+i, &key.pfrkt_t, sizeof(key.pfrkt_t)))
1349 1.1 itojun return (EFAULT);
1350 1.1 itojun if (pfr_validate_table(&key.pfrkt_t, 0, 0))
1351 1.1 itojun return (EINVAL);
1352 1.1 itojun p = RB_FIND(pfr_ktablehead, &pfr_ktables, &key);
1353 1.1 itojun if (p != NULL) {
1354 1.1 itojun SLIST_INSERT_HEAD(&workq, p, pfrkt_workq);
1355 1.1 itojun xzero++;
1356 1.1 itojun }
1357 1.1 itojun }
1358 1.1 itojun if (!(flags & PFR_FLAG_DUMMY)) {
1359 1.1 itojun if (flags & PFR_FLAG_ATOMIC)
1360 1.1 itojun s = splsoftnet();
1361 1.1 itojun pfr_clstats_ktables(&workq, tzero, flags & PFR_FLAG_ADDRSTOO);
1362 1.1 itojun if (flags & PFR_FLAG_ATOMIC)
1363 1.1 itojun splx(s);
1364 1.1 itojun }
1365 1.1 itojun if (nzero != NULL)
1366 1.1 itojun *nzero = xzero;
1367 1.1 itojun return (0);
1368 1.1 itojun }
1369 1.1 itojun
1370 1.1 itojun int
1371 1.1 itojun pfr_set_tflags(struct pfr_table *tbl, int size, int setflag, int clrflag,
1372 1.1 itojun int *nchange, int *ndel, int flags)
1373 1.1 itojun {
1374 1.1 itojun struct pfr_ktableworkq workq;
1375 1.1 itojun struct pfr_ktable *p, *q, key;
1376 1.2 itojun int i, s = 0, xchange = 0, xdel = 0;
1377 1.1 itojun
1378 1.1 itojun ACCEPT_FLAGS(PFR_FLAG_ATOMIC+PFR_FLAG_DUMMY);
1379 1.1 itojun if ((setflag & ~PFR_TFLAG_USRMASK) ||
1380 1.1 itojun (clrflag & ~PFR_TFLAG_USRMASK) ||
1381 1.1 itojun (setflag & clrflag))
1382 1.1 itojun return (EINVAL);
1383 1.1 itojun SLIST_INIT(&workq);
1384 1.1 itojun for (i = 0; i < size; i++) {
1385 1.1 itojun if (COPYIN(tbl+i, &key.pfrkt_t, sizeof(key.pfrkt_t)))
1386 1.1 itojun return (EFAULT);
1387 1.1 itojun if (pfr_validate_table(&key.pfrkt_t, 0,
1388 1.1 itojun flags & PFR_FLAG_USERIOCTL))
1389 1.1 itojun return (EINVAL);
1390 1.1 itojun p = RB_FIND(pfr_ktablehead, &pfr_ktables, &key);
1391 1.1 itojun if (p != NULL && (p->pfrkt_flags & PFR_TFLAG_ACTIVE)) {
1392 1.1 itojun p->pfrkt_nflags = (p->pfrkt_flags | setflag) &
1393 1.1 itojun ~clrflag;
1394 1.1 itojun if (p->pfrkt_nflags == p->pfrkt_flags)
1395 1.1 itojun goto _skip;
1396 1.1 itojun SLIST_FOREACH(q, &workq, pfrkt_workq)
1397 1.1 itojun if (!pfr_ktable_compare(p, q))
1398 1.1 itojun goto _skip;
1399 1.1 itojun SLIST_INSERT_HEAD(&workq, p, pfrkt_workq);
1400 1.1 itojun if ((p->pfrkt_flags & PFR_TFLAG_PERSIST) &&
1401 1.1 itojun (clrflag & PFR_TFLAG_PERSIST) &&
1402 1.1 itojun !(p->pfrkt_flags & PFR_TFLAG_REFERENCED))
1403 1.1 itojun xdel++;
1404 1.1 itojun else
1405 1.1 itojun xchange++;
1406 1.1 itojun }
1407 1.1 itojun _skip:
1408 1.1 itojun ;
1409 1.1 itojun }
1410 1.1 itojun if (!(flags & PFR_FLAG_DUMMY)) {
1411 1.1 itojun if (flags & PFR_FLAG_ATOMIC)
1412 1.1 itojun s = splsoftnet();
1413 1.1 itojun pfr_setflags_ktables(&workq);
1414 1.1 itojun if (flags & PFR_FLAG_ATOMIC)
1415 1.1 itojun splx(s);
1416 1.1 itojun }
1417 1.1 itojun if (nchange != NULL)
1418 1.1 itojun *nchange = xchange;
1419 1.1 itojun if (ndel != NULL)
1420 1.1 itojun *ndel = xdel;
1421 1.1 itojun return (0);
1422 1.1 itojun }
1423 1.1 itojun
1424 1.1 itojun int
1425 1.1 itojun pfr_ina_begin(struct pfr_table *trs, u_int32_t *ticket, int *ndel, int flags)
1426 1.1 itojun {
1427 1.1 itojun struct pfr_ktableworkq workq;
1428 1.1 itojun struct pfr_ktable *p;
1429 1.1 itojun struct pf_ruleset *rs;
1430 1.1 itojun int xdel = 0;
1431 1.1 itojun
1432 1.1 itojun ACCEPT_FLAGS(PFR_FLAG_DUMMY);
1433 1.5 yamt rs = pf_find_or_create_ruleset(trs->pfrt_anchor);
1434 1.1 itojun if (rs == NULL)
1435 1.1 itojun return (ENOMEM);
1436 1.1 itojun SLIST_INIT(&workq);
1437 1.1 itojun RB_FOREACH(p, pfr_ktablehead, &pfr_ktables) {
1438 1.1 itojun if (!(p->pfrkt_flags & PFR_TFLAG_INACTIVE) ||
1439 1.1 itojun pfr_skip_table(trs, p, 0))
1440 1.1 itojun continue;
1441 1.1 itojun p->pfrkt_nflags = p->pfrkt_flags & ~PFR_TFLAG_INACTIVE;
1442 1.1 itojun SLIST_INSERT_HEAD(&workq, p, pfrkt_workq);
1443 1.1 itojun xdel++;
1444 1.1 itojun }
1445 1.1 itojun if (!(flags & PFR_FLAG_DUMMY)) {
1446 1.1 itojun pfr_setflags_ktables(&workq);
1447 1.1 itojun if (ticket != NULL)
1448 1.1 itojun *ticket = ++rs->tticket;
1449 1.1 itojun rs->topen = 1;
1450 1.1 itojun } else
1451 1.1 itojun pf_remove_if_empty_ruleset(rs);
1452 1.1 itojun if (ndel != NULL)
1453 1.1 itojun *ndel = xdel;
1454 1.1 itojun return (0);
1455 1.1 itojun }
1456 1.1 itojun
1457 1.1 itojun int
1458 1.1 itojun pfr_ina_define(struct pfr_table *tbl, struct pfr_addr *addr, int size,
1459 1.1 itojun int *nadd, int *naddr, u_int32_t ticket, int flags)
1460 1.1 itojun {
1461 1.1 itojun struct pfr_ktableworkq tableq;
1462 1.1 itojun struct pfr_kentryworkq addrq;
1463 1.1 itojun struct pfr_ktable *kt, *rt, *shadow, key;
1464 1.1 itojun struct pfr_kentry *p;
1465 1.1 itojun struct pfr_addr ad;
1466 1.1 itojun struct pf_ruleset *rs;
1467 1.1 itojun int i, rv, xadd = 0, xaddr = 0;
1468 1.1 itojun
1469 1.1 itojun ACCEPT_FLAGS(PFR_FLAG_DUMMY|PFR_FLAG_ADDRSTOO);
1470 1.1 itojun if (size && !(flags & PFR_FLAG_ADDRSTOO))
1471 1.1 itojun return (EINVAL);
1472 1.1 itojun if (pfr_validate_table(tbl, PFR_TFLAG_USRMASK,
1473 1.1 itojun flags & PFR_FLAG_USERIOCTL))
1474 1.1 itojun return (EINVAL);
1475 1.5 yamt rs = pf_find_ruleset(tbl->pfrt_anchor);
1476 1.1 itojun if (rs == NULL || !rs->topen || ticket != rs->tticket)
1477 1.1 itojun return (EBUSY);
1478 1.1 itojun tbl->pfrt_flags |= PFR_TFLAG_INACTIVE;
1479 1.1 itojun SLIST_INIT(&tableq);
1480 1.1 itojun kt = RB_FIND(pfr_ktablehead, &pfr_ktables, (struct pfr_ktable *)tbl);
1481 1.1 itojun if (kt == NULL) {
1482 1.1 itojun kt = pfr_create_ktable(tbl, 0, 1);
1483 1.1 itojun if (kt == NULL)
1484 1.1 itojun return (ENOMEM);
1485 1.1 itojun SLIST_INSERT_HEAD(&tableq, kt, pfrkt_workq);
1486 1.1 itojun xadd++;
1487 1.1 itojun if (!tbl->pfrt_anchor[0])
1488 1.1 itojun goto _skip;
1489 1.1 itojun
1490 1.1 itojun /* find or create root table */
1491 1.1 itojun bzero(&key, sizeof(key));
1492 1.1 itojun strlcpy(key.pfrkt_name, tbl->pfrt_name, sizeof(key.pfrkt_name));
1493 1.1 itojun rt = RB_FIND(pfr_ktablehead, &pfr_ktables, &key);
1494 1.1 itojun if (rt != NULL) {
1495 1.1 itojun kt->pfrkt_root = rt;
1496 1.1 itojun goto _skip;
1497 1.1 itojun }
1498 1.1 itojun rt = pfr_create_ktable(&key.pfrkt_t, 0, 1);
1499 1.1 itojun if (rt == NULL) {
1500 1.1 itojun pfr_destroy_ktables(&tableq, 0);
1501 1.1 itojun return (ENOMEM);
1502 1.1 itojun }
1503 1.1 itojun SLIST_INSERT_HEAD(&tableq, rt, pfrkt_workq);
1504 1.1 itojun kt->pfrkt_root = rt;
1505 1.1 itojun } else if (!(kt->pfrkt_flags & PFR_TFLAG_INACTIVE))
1506 1.1 itojun xadd++;
1507 1.1 itojun _skip:
1508 1.1 itojun shadow = pfr_create_ktable(tbl, 0, 0);
1509 1.1 itojun if (shadow == NULL) {
1510 1.1 itojun pfr_destroy_ktables(&tableq, 0);
1511 1.1 itojun return (ENOMEM);
1512 1.1 itojun }
1513 1.1 itojun SLIST_INIT(&addrq);
1514 1.1 itojun for (i = 0; i < size; i++) {
1515 1.1 itojun if (COPYIN(addr+i, &ad, sizeof(ad)))
1516 1.1 itojun senderr(EFAULT);
1517 1.1 itojun if (pfr_validate_addr(&ad))
1518 1.1 itojun senderr(EINVAL);
1519 1.1 itojun if (pfr_lookup_addr(shadow, &ad, 1) != NULL)
1520 1.1 itojun continue;
1521 1.1 itojun p = pfr_create_kentry(&ad);
1522 1.1 itojun if (p == NULL)
1523 1.1 itojun senderr(ENOMEM);
1524 1.1 itojun if (pfr_route_kentry(shadow, p)) {
1525 1.1 itojun pfr_destroy_kentry(p);
1526 1.1 itojun continue;
1527 1.1 itojun }
1528 1.1 itojun SLIST_INSERT_HEAD(&addrq, p, pfrke_workq);
1529 1.1 itojun xaddr++;
1530 1.1 itojun }
1531 1.1 itojun if (!(flags & PFR_FLAG_DUMMY)) {
1532 1.1 itojun if (kt->pfrkt_shadow != NULL)
1533 1.1 itojun pfr_destroy_ktable(kt->pfrkt_shadow, 1);
1534 1.1 itojun kt->pfrkt_flags |= PFR_TFLAG_INACTIVE;
1535 1.1 itojun pfr_insert_ktables(&tableq);
1536 1.1 itojun shadow->pfrkt_cnt = (flags & PFR_FLAG_ADDRSTOO) ?
1537 1.1 itojun xaddr : NO_ADDRESSES;
1538 1.1 itojun kt->pfrkt_shadow = shadow;
1539 1.1 itojun } else {
1540 1.1 itojun pfr_clean_node_mask(shadow, &addrq);
1541 1.1 itojun pfr_destroy_ktable(shadow, 0);
1542 1.1 itojun pfr_destroy_ktables(&tableq, 0);
1543 1.1 itojun pfr_destroy_kentries(&addrq);
1544 1.1 itojun }
1545 1.1 itojun if (nadd != NULL)
1546 1.1 itojun *nadd = xadd;
1547 1.1 itojun if (naddr != NULL)
1548 1.1 itojun *naddr = xaddr;
1549 1.1 itojun return (0);
1550 1.1 itojun _bad:
1551 1.1 itojun pfr_destroy_ktable(shadow, 0);
1552 1.1 itojun pfr_destroy_ktables(&tableq, 0);
1553 1.1 itojun pfr_destroy_kentries(&addrq);
1554 1.1 itojun return (rv);
1555 1.1 itojun }
1556 1.1 itojun
1557 1.1 itojun int
1558 1.1 itojun pfr_ina_rollback(struct pfr_table *trs, u_int32_t ticket, int *ndel, int flags)
1559 1.1 itojun {
1560 1.1 itojun struct pfr_ktableworkq workq;
1561 1.1 itojun struct pfr_ktable *p;
1562 1.1 itojun struct pf_ruleset *rs;
1563 1.1 itojun int xdel = 0;
1564 1.1 itojun
1565 1.1 itojun ACCEPT_FLAGS(PFR_FLAG_DUMMY);
1566 1.5 yamt rs = pf_find_ruleset(trs->pfrt_anchor);
1567 1.1 itojun if (rs == NULL || !rs->topen || ticket != rs->tticket)
1568 1.1 itojun return (0);
1569 1.1 itojun SLIST_INIT(&workq);
1570 1.1 itojun RB_FOREACH(p, pfr_ktablehead, &pfr_ktables) {
1571 1.1 itojun if (!(p->pfrkt_flags & PFR_TFLAG_INACTIVE) ||
1572 1.1 itojun pfr_skip_table(trs, p, 0))
1573 1.1 itojun continue;
1574 1.1 itojun p->pfrkt_nflags = p->pfrkt_flags & ~PFR_TFLAG_INACTIVE;
1575 1.1 itojun SLIST_INSERT_HEAD(&workq, p, pfrkt_workq);
1576 1.1 itojun xdel++;
1577 1.1 itojun }
1578 1.1 itojun if (!(flags & PFR_FLAG_DUMMY)) {
1579 1.1 itojun pfr_setflags_ktables(&workq);
1580 1.1 itojun rs->topen = 0;
1581 1.1 itojun pf_remove_if_empty_ruleset(rs);
1582 1.1 itojun }
1583 1.1 itojun if (ndel != NULL)
1584 1.1 itojun *ndel = xdel;
1585 1.1 itojun return (0);
1586 1.1 itojun }
1587 1.1 itojun
1588 1.1 itojun int
1589 1.1 itojun pfr_ina_commit(struct pfr_table *trs, u_int32_t ticket, int *nadd,
1590 1.1 itojun int *nchange, int flags)
1591 1.1 itojun {
1592 1.4 yamt struct pfr_ktable *p, *q;
1593 1.1 itojun struct pfr_ktableworkq workq;
1594 1.1 itojun struct pf_ruleset *rs;
1595 1.5 yamt int s = 0 /* XXX gcc */, xadd = 0, xchange = 0;
1596 1.5 yamt long tzero = time_second;
1597 1.1 itojun
1598 1.1 itojun ACCEPT_FLAGS(PFR_FLAG_ATOMIC+PFR_FLAG_DUMMY);
1599 1.5 yamt rs = pf_find_ruleset(trs->pfrt_anchor);
1600 1.1 itojun if (rs == NULL || !rs->topen || ticket != rs->tticket)
1601 1.1 itojun return (EBUSY);
1602 1.1 itojun
1603 1.1 itojun SLIST_INIT(&workq);
1604 1.1 itojun RB_FOREACH(p, pfr_ktablehead, &pfr_ktables) {
1605 1.1 itojun if (!(p->pfrkt_flags & PFR_TFLAG_INACTIVE) ||
1606 1.1 itojun pfr_skip_table(trs, p, 0))
1607 1.1 itojun continue;
1608 1.1 itojun SLIST_INSERT_HEAD(&workq, p, pfrkt_workq);
1609 1.1 itojun if (p->pfrkt_flags & PFR_TFLAG_ACTIVE)
1610 1.1 itojun xchange++;
1611 1.1 itojun else
1612 1.1 itojun xadd++;
1613 1.1 itojun }
1614 1.1 itojun
1615 1.1 itojun if (!(flags & PFR_FLAG_DUMMY)) {
1616 1.1 itojun if (flags & PFR_FLAG_ATOMIC)
1617 1.1 itojun s = splsoftnet();
1618 1.4 yamt for (p = SLIST_FIRST(&workq); p != NULL; p = q) {
1619 1.4 yamt q = SLIST_NEXT(p, pfrkt_workq);
1620 1.1 itojun pfr_commit_ktable(p, tzero);
1621 1.4 yamt }
1622 1.1 itojun if (flags & PFR_FLAG_ATOMIC)
1623 1.1 itojun splx(s);
1624 1.1 itojun rs->topen = 0;
1625 1.1 itojun pf_remove_if_empty_ruleset(rs);
1626 1.1 itojun }
1627 1.1 itojun if (nadd != NULL)
1628 1.1 itojun *nadd = xadd;
1629 1.1 itojun if (nchange != NULL)
1630 1.1 itojun *nchange = xchange;
1631 1.1 itojun
1632 1.1 itojun return (0);
1633 1.1 itojun }
1634 1.1 itojun
1635 1.1 itojun void
1636 1.1 itojun pfr_commit_ktable(struct pfr_ktable *kt, long tzero)
1637 1.1 itojun {
1638 1.1 itojun struct pfr_ktable *shadow = kt->pfrkt_shadow;
1639 1.1 itojun int nflags;
1640 1.1 itojun
1641 1.1 itojun if (shadow->pfrkt_cnt == NO_ADDRESSES) {
1642 1.1 itojun if (!(kt->pfrkt_flags & PFR_TFLAG_ACTIVE))
1643 1.1 itojun pfr_clstats_ktable(kt, tzero, 1);
1644 1.1 itojun } else if (kt->pfrkt_flags & PFR_TFLAG_ACTIVE) {
1645 1.1 itojun /* kt might contain addresses */
1646 1.1 itojun struct pfr_kentryworkq addrq, addq, changeq, delq, garbageq;
1647 1.1 itojun struct pfr_kentry *p, *q, *next;
1648 1.1 itojun struct pfr_addr ad;
1649 1.1 itojun
1650 1.1 itojun pfr_enqueue_addrs(shadow, &addrq, NULL, 0);
1651 1.1 itojun pfr_mark_addrs(kt);
1652 1.1 itojun SLIST_INIT(&addq);
1653 1.1 itojun SLIST_INIT(&changeq);
1654 1.1 itojun SLIST_INIT(&delq);
1655 1.1 itojun SLIST_INIT(&garbageq);
1656 1.1 itojun pfr_clean_node_mask(shadow, &addrq);
1657 1.1 itojun for (p = SLIST_FIRST(&addrq); p != NULL; p = next) {
1658 1.1 itojun next = SLIST_NEXT(p, pfrke_workq); /* XXX */
1659 1.1 itojun pfr_copyout_addr(&ad, p);
1660 1.1 itojun q = pfr_lookup_addr(kt, &ad, 1);
1661 1.1 itojun if (q != NULL) {
1662 1.1 itojun if (q->pfrke_not != p->pfrke_not)
1663 1.1 itojun SLIST_INSERT_HEAD(&changeq, q,
1664 1.1 itojun pfrke_workq);
1665 1.1 itojun q->pfrke_mark = 1;
1666 1.1 itojun SLIST_INSERT_HEAD(&garbageq, p, pfrke_workq);
1667 1.1 itojun } else {
1668 1.1 itojun p->pfrke_tzero = tzero;
1669 1.1 itojun SLIST_INSERT_HEAD(&addq, p, pfrke_workq);
1670 1.1 itojun }
1671 1.1 itojun }
1672 1.1 itojun pfr_enqueue_addrs(kt, &delq, NULL, ENQUEUE_UNMARKED_ONLY);
1673 1.1 itojun pfr_insert_kentries(kt, &addq, tzero);
1674 1.1 itojun pfr_remove_kentries(kt, &delq);
1675 1.1 itojun pfr_clstats_kentries(&changeq, tzero, INVERT_NEG_FLAG);
1676 1.1 itojun pfr_destroy_kentries(&garbageq);
1677 1.1 itojun } else {
1678 1.1 itojun /* kt cannot contain addresses */
1679 1.1 itojun SWAP(struct radix_node_head *, kt->pfrkt_ip4,
1680 1.1 itojun shadow->pfrkt_ip4);
1681 1.1 itojun SWAP(struct radix_node_head *, kt->pfrkt_ip6,
1682 1.1 itojun shadow->pfrkt_ip6);
1683 1.1 itojun SWAP(int, kt->pfrkt_cnt, shadow->pfrkt_cnt);
1684 1.1 itojun pfr_clstats_ktable(kt, tzero, 1);
1685 1.1 itojun }
1686 1.1 itojun nflags = ((shadow->pfrkt_flags & PFR_TFLAG_USRMASK) |
1687 1.1 itojun (kt->pfrkt_flags & PFR_TFLAG_SETMASK) | PFR_TFLAG_ACTIVE)
1688 1.1 itojun & ~PFR_TFLAG_INACTIVE;
1689 1.1 itojun pfr_destroy_ktable(shadow, 0);
1690 1.1 itojun kt->pfrkt_shadow = NULL;
1691 1.1 itojun pfr_setflags_ktable(kt, nflags);
1692 1.1 itojun }
1693 1.1 itojun
1694 1.1 itojun int
1695 1.1 itojun pfr_validate_table(struct pfr_table *tbl, int allowedflags, int no_reserved)
1696 1.1 itojun {
1697 1.1 itojun int i;
1698 1.1 itojun
1699 1.1 itojun if (!tbl->pfrt_name[0])
1700 1.1 itojun return (-1);
1701 1.1 itojun if (no_reserved && !strcmp(tbl->pfrt_anchor, PF_RESERVED_ANCHOR))
1702 1.1 itojun return (-1);
1703 1.1 itojun if (tbl->pfrt_name[PF_TABLE_NAME_SIZE-1])
1704 1.1 itojun return (-1);
1705 1.1 itojun for (i = strlen(tbl->pfrt_name); i < PF_TABLE_NAME_SIZE; i++)
1706 1.1 itojun if (tbl->pfrt_name[i])
1707 1.1 itojun return (-1);
1708 1.1 itojun if (tbl->pfrt_flags & ~allowedflags)
1709 1.1 itojun return (-1);
1710 1.1 itojun return (0);
1711 1.1 itojun }
1712 1.1 itojun
1713 1.1 itojun int
1714 1.1 itojun pfr_table_count(struct pfr_table *filter, int flags)
1715 1.1 itojun {
1716 1.1 itojun struct pf_ruleset *rs;
1717 1.1 itojun
1718 1.1 itojun if (flags & PFR_FLAG_ALLRSETS)
1719 1.1 itojun return (pfr_ktable_cnt);
1720 1.5 yamt if (filter->pfrt_anchor[0]) {
1721 1.5 yamt rs = pf_find_ruleset(filter->pfrt_anchor);
1722 1.1 itojun return ((rs != NULL) ? rs->tables : -1);
1723 1.1 itojun }
1724 1.1 itojun return (pf_main_ruleset.tables);
1725 1.1 itojun }
1726 1.1 itojun
1727 1.1 itojun int
1728 1.1 itojun pfr_skip_table(struct pfr_table *filter, struct pfr_ktable *kt, int flags)
1729 1.1 itojun {
1730 1.1 itojun if (flags & PFR_FLAG_ALLRSETS)
1731 1.1 itojun return (0);
1732 1.5 yamt if (strcmp(filter->pfrt_anchor, kt->pfrkt_anchor))
1733 1.1 itojun return (1);
1734 1.1 itojun return (0);
1735 1.1 itojun }
1736 1.1 itojun
1737 1.1 itojun void
1738 1.1 itojun pfr_insert_ktables(struct pfr_ktableworkq *workq)
1739 1.1 itojun {
1740 1.1 itojun struct pfr_ktable *p;
1741 1.1 itojun
1742 1.1 itojun SLIST_FOREACH(p, workq, pfrkt_workq)
1743 1.1 itojun pfr_insert_ktable(p);
1744 1.1 itojun }
1745 1.1 itojun
1746 1.1 itojun void
1747 1.1 itojun pfr_insert_ktable(struct pfr_ktable *kt)
1748 1.1 itojun {
1749 1.1 itojun RB_INSERT(pfr_ktablehead, &pfr_ktables, kt);
1750 1.1 itojun pfr_ktable_cnt++;
1751 1.1 itojun if (kt->pfrkt_root != NULL)
1752 1.1 itojun if (!kt->pfrkt_root->pfrkt_refcnt[PFR_REFCNT_ANCHOR]++)
1753 1.1 itojun pfr_setflags_ktable(kt->pfrkt_root,
1754 1.1 itojun kt->pfrkt_root->pfrkt_flags|PFR_TFLAG_REFDANCHOR);
1755 1.1 itojun }
1756 1.1 itojun
1757 1.1 itojun void
1758 1.1 itojun pfr_setflags_ktables(struct pfr_ktableworkq *workq)
1759 1.1 itojun {
1760 1.4 yamt struct pfr_ktable *p, *q;
1761 1.1 itojun
1762 1.4 yamt for (p = SLIST_FIRST(workq); p; p = q) {
1763 1.4 yamt q = SLIST_NEXT(p, pfrkt_workq);
1764 1.1 itojun pfr_setflags_ktable(p, p->pfrkt_nflags);
1765 1.4 yamt }
1766 1.1 itojun }
1767 1.1 itojun
1768 1.1 itojun void
1769 1.1 itojun pfr_setflags_ktable(struct pfr_ktable *kt, int newf)
1770 1.1 itojun {
1771 1.1 itojun struct pfr_kentryworkq addrq;
1772 1.1 itojun
1773 1.1 itojun if (!(newf & PFR_TFLAG_REFERENCED) &&
1774 1.1 itojun !(newf & PFR_TFLAG_PERSIST))
1775 1.1 itojun newf &= ~PFR_TFLAG_ACTIVE;
1776 1.1 itojun if (!(newf & PFR_TFLAG_ACTIVE))
1777 1.1 itojun newf &= ~PFR_TFLAG_USRMASK;
1778 1.1 itojun if (!(newf & PFR_TFLAG_SETMASK)) {
1779 1.1 itojun RB_REMOVE(pfr_ktablehead, &pfr_ktables, kt);
1780 1.1 itojun if (kt->pfrkt_root != NULL)
1781 1.1 itojun if (!--kt->pfrkt_root->pfrkt_refcnt[PFR_REFCNT_ANCHOR])
1782 1.1 itojun pfr_setflags_ktable(kt->pfrkt_root,
1783 1.1 itojun kt->pfrkt_root->pfrkt_flags &
1784 1.1 itojun ~PFR_TFLAG_REFDANCHOR);
1785 1.1 itojun pfr_destroy_ktable(kt, 1);
1786 1.1 itojun pfr_ktable_cnt--;
1787 1.1 itojun return;
1788 1.1 itojun }
1789 1.1 itojun if (!(newf & PFR_TFLAG_ACTIVE) && kt->pfrkt_cnt) {
1790 1.1 itojun pfr_enqueue_addrs(kt, &addrq, NULL, 0);
1791 1.1 itojun pfr_remove_kentries(kt, &addrq);
1792 1.1 itojun }
1793 1.1 itojun if (!(newf & PFR_TFLAG_INACTIVE) && kt->pfrkt_shadow != NULL) {
1794 1.1 itojun pfr_destroy_ktable(kt->pfrkt_shadow, 1);
1795 1.1 itojun kt->pfrkt_shadow = NULL;
1796 1.1 itojun }
1797 1.1 itojun kt->pfrkt_flags = newf;
1798 1.1 itojun }
1799 1.1 itojun
1800 1.1 itojun void
1801 1.1 itojun pfr_clstats_ktables(struct pfr_ktableworkq *workq, long tzero, int recurse)
1802 1.1 itojun {
1803 1.1 itojun struct pfr_ktable *p;
1804 1.1 itojun
1805 1.1 itojun SLIST_FOREACH(p, workq, pfrkt_workq)
1806 1.1 itojun pfr_clstats_ktable(p, tzero, recurse);
1807 1.1 itojun }
1808 1.1 itojun
1809 1.1 itojun void
1810 1.1 itojun pfr_clstats_ktable(struct pfr_ktable *kt, long tzero, int recurse)
1811 1.1 itojun {
1812 1.1 itojun struct pfr_kentryworkq addrq;
1813 1.1 itojun int s;
1814 1.1 itojun
1815 1.1 itojun if (recurse) {
1816 1.1 itojun pfr_enqueue_addrs(kt, &addrq, NULL, 0);
1817 1.1 itojun pfr_clstats_kentries(&addrq, tzero, 0);
1818 1.1 itojun }
1819 1.1 itojun s = splsoftnet();
1820 1.1 itojun bzero(kt->pfrkt_packets, sizeof(kt->pfrkt_packets));
1821 1.1 itojun bzero(kt->pfrkt_bytes, sizeof(kt->pfrkt_bytes));
1822 1.1 itojun kt->pfrkt_match = kt->pfrkt_nomatch = 0;
1823 1.1 itojun splx(s);
1824 1.1 itojun kt->pfrkt_tzero = tzero;
1825 1.1 itojun }
1826 1.1 itojun
1827 1.1 itojun struct pfr_ktable *
1828 1.1 itojun pfr_create_ktable(struct pfr_table *tbl, long tzero, int attachruleset)
1829 1.1 itojun {
1830 1.1 itojun struct pfr_ktable *kt;
1831 1.1 itojun struct pf_ruleset *rs;
1832 1.1 itojun
1833 1.1 itojun kt = pool_get(&pfr_ktable_pl, PR_NOWAIT);
1834 1.1 itojun if (kt == NULL)
1835 1.1 itojun return (NULL);
1836 1.1 itojun bzero(kt, sizeof(*kt));
1837 1.1 itojun kt->pfrkt_t = *tbl;
1838 1.1 itojun
1839 1.1 itojun if (attachruleset) {
1840 1.5 yamt rs = pf_find_or_create_ruleset(tbl->pfrt_anchor);
1841 1.1 itojun if (!rs) {
1842 1.1 itojun pfr_destroy_ktable(kt, 0);
1843 1.1 itojun return (NULL);
1844 1.1 itojun }
1845 1.1 itojun kt->pfrkt_rs = rs;
1846 1.1 itojun rs->tables++;
1847 1.1 itojun }
1848 1.1 itojun
1849 1.1 itojun if (!rn_inithead((void **)&kt->pfrkt_ip4,
1850 1.1 itojun offsetof(struct sockaddr_in, sin_addr) * 8) ||
1851 1.1 itojun !rn_inithead((void **)&kt->pfrkt_ip6,
1852 1.1 itojun offsetof(struct sockaddr_in6, sin6_addr) * 8)) {
1853 1.1 itojun pfr_destroy_ktable(kt, 0);
1854 1.1 itojun return (NULL);
1855 1.1 itojun }
1856 1.1 itojun kt->pfrkt_tzero = tzero;
1857 1.1 itojun
1858 1.1 itojun return (kt);
1859 1.1 itojun }
1860 1.1 itojun
1861 1.1 itojun void
1862 1.1 itojun pfr_destroy_ktables(struct pfr_ktableworkq *workq, int flushaddr)
1863 1.1 itojun {
1864 1.1 itojun struct pfr_ktable *p, *q;
1865 1.1 itojun
1866 1.1 itojun for (p = SLIST_FIRST(workq); p; p = q) {
1867 1.1 itojun q = SLIST_NEXT(p, pfrkt_workq);
1868 1.1 itojun pfr_destroy_ktable(p, flushaddr);
1869 1.1 itojun }
1870 1.1 itojun }
1871 1.1 itojun
1872 1.1 itojun void
1873 1.1 itojun pfr_destroy_ktable(struct pfr_ktable *kt, int flushaddr)
1874 1.1 itojun {
1875 1.1 itojun struct pfr_kentryworkq addrq;
1876 1.1 itojun
1877 1.1 itojun if (flushaddr) {
1878 1.1 itojun pfr_enqueue_addrs(kt, &addrq, NULL, 0);
1879 1.1 itojun pfr_clean_node_mask(kt, &addrq);
1880 1.1 itojun pfr_destroy_kentries(&addrq);
1881 1.1 itojun }
1882 1.1 itojun if (kt->pfrkt_ip4 != NULL)
1883 1.1 itojun free((caddr_t)kt->pfrkt_ip4, M_RTABLE);
1884 1.1 itojun if (kt->pfrkt_ip6 != NULL)
1885 1.1 itojun free((caddr_t)kt->pfrkt_ip6, M_RTABLE);
1886 1.1 itojun if (kt->pfrkt_shadow != NULL)
1887 1.1 itojun pfr_destroy_ktable(kt->pfrkt_shadow, flushaddr);
1888 1.1 itojun if (kt->pfrkt_rs != NULL) {
1889 1.1 itojun kt->pfrkt_rs->tables--;
1890 1.1 itojun pf_remove_if_empty_ruleset(kt->pfrkt_rs);
1891 1.1 itojun }
1892 1.1 itojun pool_put(&pfr_ktable_pl, kt);
1893 1.1 itojun }
1894 1.1 itojun
1895 1.1 itojun int
1896 1.1 itojun pfr_ktable_compare(struct pfr_ktable *p, struct pfr_ktable *q)
1897 1.1 itojun {
1898 1.1 itojun int d;
1899 1.1 itojun
1900 1.1 itojun if ((d = strncmp(p->pfrkt_name, q->pfrkt_name, PF_TABLE_NAME_SIZE)))
1901 1.1 itojun return (d);
1902 1.5 yamt return (strcmp(p->pfrkt_anchor, q->pfrkt_anchor));
1903 1.1 itojun }
1904 1.1 itojun
1905 1.1 itojun struct pfr_ktable *
1906 1.1 itojun pfr_lookup_table(struct pfr_table *tbl)
1907 1.1 itojun {
1908 1.1 itojun /* struct pfr_ktable start like a struct pfr_table */
1909 1.1 itojun return (RB_FIND(pfr_ktablehead, &pfr_ktables,
1910 1.1 itojun (struct pfr_ktable *)tbl));
1911 1.1 itojun }
1912 1.1 itojun
1913 1.1 itojun int
1914 1.1 itojun pfr_match_addr(struct pfr_ktable *kt, struct pf_addr *a, sa_family_t af)
1915 1.1 itojun {
1916 1.1 itojun struct pfr_kentry *ke = NULL;
1917 1.1 itojun int match;
1918 1.1 itojun
1919 1.1 itojun if (!(kt->pfrkt_flags & PFR_TFLAG_ACTIVE) && kt->pfrkt_root != NULL)
1920 1.1 itojun kt = kt->pfrkt_root;
1921 1.1 itojun if (!(kt->pfrkt_flags & PFR_TFLAG_ACTIVE))
1922 1.1 itojun return (0);
1923 1.1 itojun
1924 1.1 itojun switch (af) {
1925 1.5 yamt #ifdef INET
1926 1.1 itojun case AF_INET:
1927 1.1 itojun pfr_sin.sin_addr.s_addr = a->addr32[0];
1928 1.1 itojun ke = (struct pfr_kentry *)rn_match(&pfr_sin, kt->pfrkt_ip4);
1929 1.1 itojun if (ke && KENTRY_RNF_ROOT(ke))
1930 1.1 itojun ke = NULL;
1931 1.1 itojun break;
1932 1.5 yamt #endif /* INET */
1933 1.5 yamt #ifdef INET6
1934 1.1 itojun case AF_INET6:
1935 1.1 itojun bcopy(a, &pfr_sin6.sin6_addr, sizeof(pfr_sin6.sin6_addr));
1936 1.1 itojun ke = (struct pfr_kentry *)rn_match(&pfr_sin6, kt->pfrkt_ip6);
1937 1.1 itojun if (ke && KENTRY_RNF_ROOT(ke))
1938 1.1 itojun ke = NULL;
1939 1.1 itojun break;
1940 1.5 yamt #endif /* INET6 */
1941 1.1 itojun }
1942 1.1 itojun match = (ke && !ke->pfrke_not);
1943 1.1 itojun if (match)
1944 1.1 itojun kt->pfrkt_match++;
1945 1.1 itojun else
1946 1.1 itojun kt->pfrkt_nomatch++;
1947 1.1 itojun return (match);
1948 1.1 itojun }
1949 1.1 itojun
1950 1.1 itojun void
1951 1.1 itojun pfr_update_stats(struct pfr_ktable *kt, struct pf_addr *a, sa_family_t af,
1952 1.1 itojun u_int64_t len, int dir_out, int op_pass, int notrule)
1953 1.1 itojun {
1954 1.1 itojun struct pfr_kentry *ke = NULL;
1955 1.1 itojun
1956 1.1 itojun if (!(kt->pfrkt_flags & PFR_TFLAG_ACTIVE) && kt->pfrkt_root != NULL)
1957 1.1 itojun kt = kt->pfrkt_root;
1958 1.1 itojun if (!(kt->pfrkt_flags & PFR_TFLAG_ACTIVE))
1959 1.1 itojun return;
1960 1.1 itojun
1961 1.1 itojun switch (af) {
1962 1.5 yamt #ifdef INET
1963 1.1 itojun case AF_INET:
1964 1.1 itojun pfr_sin.sin_addr.s_addr = a->addr32[0];
1965 1.1 itojun ke = (struct pfr_kentry *)rn_match(&pfr_sin, kt->pfrkt_ip4);
1966 1.1 itojun if (ke && KENTRY_RNF_ROOT(ke))
1967 1.1 itojun ke = NULL;
1968 1.1 itojun break;
1969 1.5 yamt #endif /* INET */
1970 1.5 yamt #ifdef INET6
1971 1.1 itojun case AF_INET6:
1972 1.1 itojun bcopy(a, &pfr_sin6.sin6_addr, sizeof(pfr_sin6.sin6_addr));
1973 1.1 itojun ke = (struct pfr_kentry *)rn_match(&pfr_sin6, kt->pfrkt_ip6);
1974 1.1 itojun if (ke && KENTRY_RNF_ROOT(ke))
1975 1.1 itojun ke = NULL;
1976 1.1 itojun break;
1977 1.5 yamt #endif /* INET6 */
1978 1.5 yamt default:
1979 1.5 yamt ;
1980 1.1 itojun }
1981 1.1 itojun if ((ke == NULL || ke->pfrke_not) != notrule) {
1982 1.1 itojun if (op_pass != PFR_OP_PASS)
1983 1.1 itojun printf("pfr_update_stats: assertion failed.\n");
1984 1.1 itojun op_pass = PFR_OP_XPASS;
1985 1.1 itojun }
1986 1.1 itojun kt->pfrkt_packets[dir_out][op_pass]++;
1987 1.1 itojun kt->pfrkt_bytes[dir_out][op_pass] += len;
1988 1.1 itojun if (ke != NULL && op_pass != PFR_OP_XPASS) {
1989 1.1 itojun ke->pfrke_packets[dir_out][op_pass]++;
1990 1.1 itojun ke->pfrke_bytes[dir_out][op_pass] += len;
1991 1.1 itojun }
1992 1.1 itojun }
1993 1.1 itojun
1994 1.1 itojun struct pfr_ktable *
1995 1.1 itojun pfr_attach_table(struct pf_ruleset *rs, char *name)
1996 1.1 itojun {
1997 1.1 itojun struct pfr_ktable *kt, *rt;
1998 1.1 itojun struct pfr_table tbl;
1999 1.1 itojun struct pf_anchor *ac = rs->anchor;
2000 1.1 itojun
2001 1.1 itojun bzero(&tbl, sizeof(tbl));
2002 1.1 itojun strlcpy(tbl.pfrt_name, name, sizeof(tbl.pfrt_name));
2003 1.5 yamt if (ac != NULL)
2004 1.1 itojun strlcpy(tbl.pfrt_anchor, ac->name, sizeof(tbl.pfrt_anchor));
2005 1.1 itojun kt = pfr_lookup_table(&tbl);
2006 1.1 itojun if (kt == NULL) {
2007 1.5 yamt kt = pfr_create_ktable(&tbl, time_second, 1);
2008 1.1 itojun if (kt == NULL)
2009 1.1 itojun return (NULL);
2010 1.1 itojun if (ac != NULL) {
2011 1.1 itojun bzero(tbl.pfrt_anchor, sizeof(tbl.pfrt_anchor));
2012 1.1 itojun rt = pfr_lookup_table(&tbl);
2013 1.1 itojun if (rt == NULL) {
2014 1.1 itojun rt = pfr_create_ktable(&tbl, 0, 1);
2015 1.1 itojun if (rt == NULL) {
2016 1.1 itojun pfr_destroy_ktable(kt, 0);
2017 1.1 itojun return (NULL);
2018 1.1 itojun }
2019 1.1 itojun pfr_insert_ktable(rt);
2020 1.1 itojun }
2021 1.1 itojun kt->pfrkt_root = rt;
2022 1.1 itojun }
2023 1.1 itojun pfr_insert_ktable(kt);
2024 1.1 itojun }
2025 1.1 itojun if (!kt->pfrkt_refcnt[PFR_REFCNT_RULE]++)
2026 1.1 itojun pfr_setflags_ktable(kt, kt->pfrkt_flags|PFR_TFLAG_REFERENCED);
2027 1.1 itojun return (kt);
2028 1.1 itojun }
2029 1.1 itojun
2030 1.1 itojun void
2031 1.1 itojun pfr_detach_table(struct pfr_ktable *kt)
2032 1.1 itojun {
2033 1.1 itojun if (kt->pfrkt_refcnt[PFR_REFCNT_RULE] <= 0)
2034 1.1 itojun printf("pfr_detach_table: refcount = %d.\n",
2035 1.1 itojun kt->pfrkt_refcnt[PFR_REFCNT_RULE]);
2036 1.1 itojun else if (!--kt->pfrkt_refcnt[PFR_REFCNT_RULE])
2037 1.1 itojun pfr_setflags_ktable(kt, kt->pfrkt_flags&~PFR_TFLAG_REFERENCED);
2038 1.1 itojun }
2039 1.1 itojun
2040 1.1 itojun int
2041 1.1 itojun pfr_pool_get(struct pfr_ktable *kt, int *pidx, struct pf_addr *counter,
2042 1.1 itojun struct pf_addr **raddr, struct pf_addr **rmask, sa_family_t af)
2043 1.1 itojun {
2044 1.5 yamt struct pfr_kentry *ke, *ke2 = (void *)0xdeadb;
2045 1.5 yamt struct pf_addr *addr = (void *)0xdeadb;
2046 1.1 itojun union sockaddr_union mask;
2047 1.1 itojun int idx = -1, use_counter = 0;
2048 1.1 itojun
2049 1.5 yamt if (af == AF_INET)
2050 1.5 yamt addr = (struct pf_addr *)&pfr_sin.sin_addr;
2051 1.5 yamt else if (af == AF_INET6)
2052 1.5 yamt addr = (struct pf_addr *)&pfr_sin6.sin6_addr;
2053 1.1 itojun if (!(kt->pfrkt_flags & PFR_TFLAG_ACTIVE) && kt->pfrkt_root != NULL)
2054 1.1 itojun kt = kt->pfrkt_root;
2055 1.1 itojun if (!(kt->pfrkt_flags & PFR_TFLAG_ACTIVE))
2056 1.1 itojun return (-1);
2057 1.1 itojun
2058 1.1 itojun if (pidx != NULL)
2059 1.1 itojun idx = *pidx;
2060 1.1 itojun if (counter != NULL && idx >= 0)
2061 1.1 itojun use_counter = 1;
2062 1.1 itojun if (idx < 0)
2063 1.1 itojun idx = 0;
2064 1.1 itojun
2065 1.1 itojun _next_block:
2066 1.1 itojun ke = pfr_kentry_byidx(kt, idx, af);
2067 1.1 itojun if (ke == NULL)
2068 1.1 itojun return (1);
2069 1.1 itojun pfr_prepare_network(&pfr_mask, af, ke->pfrke_net);
2070 1.1 itojun *raddr = SUNION2PF(&ke->pfrke_sa, af);
2071 1.1 itojun *rmask = SUNION2PF(&pfr_mask, af);
2072 1.1 itojun
2073 1.1 itojun if (use_counter) {
2074 1.1 itojun /* is supplied address within block? */
2075 1.1 itojun if (!PF_MATCHA(0, *raddr, *rmask, counter, af)) {
2076 1.1 itojun /* no, go to next block in table */
2077 1.1 itojun idx++;
2078 1.1 itojun use_counter = 0;
2079 1.1 itojun goto _next_block;
2080 1.1 itojun }
2081 1.1 itojun PF_ACPY(addr, counter, af);
2082 1.1 itojun } else {
2083 1.1 itojun /* use first address of block */
2084 1.1 itojun PF_ACPY(addr, *raddr, af);
2085 1.1 itojun }
2086 1.1 itojun
2087 1.1 itojun if (!KENTRY_NETWORK(ke)) {
2088 1.1 itojun /* this is a single IP address - no possible nested block */
2089 1.1 itojun PF_ACPY(counter, addr, af);
2090 1.1 itojun *pidx = idx;
2091 1.1 itojun return (0);
2092 1.1 itojun }
2093 1.1 itojun for (;;) {
2094 1.1 itojun /* we don't want to use a nested block */
2095 1.5 yamt if (af == AF_INET)
2096 1.5 yamt ke2 = (struct pfr_kentry *)rn_match(&pfr_sin,
2097 1.5 yamt kt->pfrkt_ip4);
2098 1.5 yamt else if (af == AF_INET6)
2099 1.5 yamt ke2 = (struct pfr_kentry *)rn_match(&pfr_sin6,
2100 1.5 yamt kt->pfrkt_ip6);
2101 1.1 itojun /* no need to check KENTRY_RNF_ROOT() here */
2102 1.1 itojun if (ke2 == ke) {
2103 1.1 itojun /* lookup return the same block - perfect */
2104 1.1 itojun PF_ACPY(counter, addr, af);
2105 1.1 itojun *pidx = idx;
2106 1.1 itojun return (0);
2107 1.1 itojun }
2108 1.1 itojun
2109 1.1 itojun /* we need to increase the counter past the nested block */
2110 1.1 itojun pfr_prepare_network(&mask, AF_INET, ke2->pfrke_net);
2111 1.1 itojun PF_POOLMASK(addr, addr, SUNION2PF(&mask, af), &pfr_ffaddr, af);
2112 1.1 itojun PF_AINC(addr, af);
2113 1.1 itojun if (!PF_MATCHA(0, *raddr, *rmask, addr, af)) {
2114 1.1 itojun /* ok, we reached the end of our main block */
2115 1.1 itojun /* go to next block in table */
2116 1.1 itojun idx++;
2117 1.1 itojun use_counter = 0;
2118 1.1 itojun goto _next_block;
2119 1.1 itojun }
2120 1.1 itojun }
2121 1.1 itojun }
2122 1.1 itojun
2123 1.1 itojun struct pfr_kentry *
2124 1.1 itojun pfr_kentry_byidx(struct pfr_ktable *kt, int idx, int af)
2125 1.1 itojun {
2126 1.1 itojun struct pfr_walktree w;
2127 1.1 itojun
2128 1.1 itojun bzero(&w, sizeof(w));
2129 1.1 itojun w.pfrw_op = PFRW_POOL_GET;
2130 1.1 itojun w.pfrw_cnt = idx;
2131 1.1 itojun
2132 1.1 itojun switch (af) {
2133 1.5 yamt #ifdef INET
2134 1.1 itojun case AF_INET:
2135 1.1 itojun rn_walktree(kt->pfrkt_ip4, pfr_walktree, &w);
2136 1.1 itojun return (w.pfrw_kentry);
2137 1.5 yamt #endif /* INET */
2138 1.5 yamt #ifdef INET6
2139 1.1 itojun case AF_INET6:
2140 1.1 itojun rn_walktree(kt->pfrkt_ip6, pfr_walktree, &w);
2141 1.1 itojun return (w.pfrw_kentry);
2142 1.5 yamt #endif /* INET6 */
2143 1.1 itojun default:
2144 1.1 itojun return (NULL);
2145 1.1 itojun }
2146 1.1 itojun }
2147 1.1 itojun
2148 1.1 itojun void
2149 1.1 itojun pfr_dynaddr_update(struct pfr_ktable *kt, struct pfi_dynaddr *dyn)
2150 1.1 itojun {
2151 1.1 itojun struct pfr_walktree w;
2152 1.1 itojun int s;
2153 1.1 itojun
2154 1.1 itojun bzero(&w, sizeof(w));
2155 1.1 itojun w.pfrw_op = PFRW_DYNADDR_UPDATE;
2156 1.1 itojun w.pfrw_dyn = dyn;
2157 1.1 itojun
2158 1.1 itojun s = splsoftnet();
2159 1.1 itojun dyn->pfid_acnt4 = 0;
2160 1.1 itojun dyn->pfid_acnt6 = 0;
2161 1.1 itojun if (!dyn->pfid_af || dyn->pfid_af == AF_INET)
2162 1.1 itojun rn_walktree(kt->pfrkt_ip4, pfr_walktree, &w);
2163 1.1 itojun if (!dyn->pfid_af || dyn->pfid_af == AF_INET6)
2164 1.1 itojun rn_walktree(kt->pfrkt_ip6, pfr_walktree, &w);
2165 1.1 itojun splx(s);
2166 1.1 itojun }
2167