1 /*-
2 * SPDX-License-Identifier: BSD-2-Clause
3 *
4 * Copyright (c) 2021 Rubicon Communications, LLC (Netgate)
5 * All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 *
11 * - Redistributions of source code must retain the above copyright
12 * notice, this list of conditions and the following disclaimer.
13 * - Redistributions in binary form must reproduce the above
14 * copyright notice, this list of conditions and the following
15 * disclaimer in the documentation and/or other materials provided
16 * with the distribution.
17 *
18 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
19 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
20 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
21 * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
22 * COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
23 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
24 * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
25 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
26 * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
27 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
28 * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29 * POSSIBILITY OF SUCH DAMAGE.
30 */
31
32 #include <sys/cdefs.h>
33
34 #include <sys/ioctl.h>
35 #include <sys/nv.h>
36 #include <sys/queue.h>
37 #include <sys/types.h>
38
39 #include <net/if.h>
40 #include <net/pfvar.h>
41 #include <netinet/in.h>
42
43 #include <netpfil/pf/pf_nl.h>
44 #include <netlink/netlink.h>
45 #include <netlink/netlink_generic.h>
46 #include <netlink/netlink_snl.h>
47 #include <netlink/netlink_snl_generic.h>
48 #include <netlink/netlink_snl_route.h>
49
50 #include <assert.h>
51 #include <err.h>
52 #include <errno.h>
53 #include <fcntl.h>
54 #include <stdlib.h>
55 #include <string.h>
56
57 #include "libpfctl.h"
58
59 struct pfctl_handle {
60 int fd;
61 struct snl_state ss;
62 };
63
64 const char* PFCTL_SYNCOOKIES_MODE_NAMES[] = {
65 "never",
66 "always",
67 "adaptive"
68 };
69
70 static int _pfctl_clear_states(int , const struct pfctl_kill *,
71 unsigned int *, uint64_t);
72
73 struct pfctl_handle *
pfctl_open(const char * pf_device)74 pfctl_open(const char *pf_device)
75 {
76 struct pfctl_handle *h;
77
78 h = calloc(1, sizeof(struct pfctl_handle));
79 h->fd = -1;
80
81 h->fd = open(pf_device, O_RDWR);
82 if (h->fd < 0)
83 goto error;
84
85 if (!snl_init(&h->ss, NETLINK_GENERIC))
86 goto error;
87
88 return (h);
89 error:
90 close(h->fd);
91 snl_free(&h->ss);
92 free(h);
93
94 return (NULL);
95 }
96
97 void
pfctl_close(struct pfctl_handle * h)98 pfctl_close(struct pfctl_handle *h)
99 {
100 close(h->fd);
101 snl_free(&h->ss);
102 free(h);
103 }
104
105 int
pfctl_fd(struct pfctl_handle * h)106 pfctl_fd(struct pfctl_handle *h)
107 {
108 return (h->fd);
109 }
110
111 static int
pfctl_do_netlink_cmd(struct pfctl_handle * h,uint cmd)112 pfctl_do_netlink_cmd(struct pfctl_handle *h, uint cmd)
113 {
114 struct snl_errmsg_data e = {};
115 struct snl_writer nw;
116 struct nlmsghdr *hdr;
117 uint32_t seq_id;
118 int family_id;
119
120 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
121 if (family_id == 0)
122 return (ENOTSUP);
123
124 snl_init_writer(&h->ss, &nw);
125 hdr = snl_create_genl_msg_request(&nw, family_id, cmd);
126
127 hdr = snl_finalize_msg(&nw);
128 if (hdr == NULL)
129 return (ENOMEM);
130 seq_id = hdr->nlmsg_seq;
131
132 snl_send_message(&h->ss, hdr);
133
134 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
135 }
136
137 return (e.error);
138 }
139
140 static int
pfctl_do_ioctl(int dev,uint cmd,size_t size,nvlist_t ** nvl)141 pfctl_do_ioctl(int dev, uint cmd, size_t size, nvlist_t **nvl)
142 {
143 struct pfioc_nv nv;
144 void *data;
145 size_t nvlen;
146 int ret;
147
148 data = nvlist_pack(*nvl, &nvlen);
149 if (nvlen > size)
150 size = nvlen;
151
152 retry:
153 nv.data = malloc(size);
154 if (nv.data == NULL) {
155 ret = ENOMEM;
156 goto out;
157 }
158
159 memcpy(nv.data, data, nvlen);
160
161 nv.len = nvlen;
162 nv.size = size;
163
164 ret = ioctl(dev, cmd, &nv);
165 if (ret == -1 && errno == ENOSPC) {
166 size *= 2;
167 free(nv.data);
168 goto retry;
169 }
170
171 nvlist_destroy(*nvl);
172 *nvl = NULL;
173
174 if (ret == 0) {
175 *nvl = nvlist_unpack(nv.data, nv.len, 0);
176 if (*nvl == NULL) {
177 ret = EIO;
178 goto out;
179 }
180 } else {
181 ret = errno;
182 }
183
184 out:
185 free(data);
186 free(nv.data);
187
188 return (ret);
189 }
190
191 static void
pf_nvuint_8_array(const nvlist_t * nvl,const char * name,size_t maxelems,uint8_t * numbers,size_t * nelems)192 pf_nvuint_8_array(const nvlist_t *nvl, const char *name, size_t maxelems,
193 uint8_t *numbers, size_t *nelems)
194 {
195 const uint64_t *tmp;
196 size_t elems;
197
198 tmp = nvlist_get_number_array(nvl, name, &elems);
199 assert(elems <= maxelems);
200
201 for (size_t i = 0; i < elems; i++)
202 numbers[i] = tmp[i];
203
204 if (nelems)
205 *nelems = elems;
206 }
207
208 static void
pf_nvuint_16_array(const nvlist_t * nvl,const char * name,size_t maxelems,uint16_t * numbers,size_t * nelems)209 pf_nvuint_16_array(const nvlist_t *nvl, const char *name, size_t maxelems,
210 uint16_t *numbers, size_t *nelems)
211 {
212 const uint64_t *tmp;
213 size_t elems;
214
215 tmp = nvlist_get_number_array(nvl, name, &elems);
216 assert(elems <= maxelems);
217
218 for (size_t i = 0; i < elems; i++)
219 numbers[i] = tmp[i];
220
221 if (nelems)
222 *nelems = elems;
223 }
224
225 static void
pf_nvuint_32_array(const nvlist_t * nvl,const char * name,size_t maxelems,uint32_t * numbers,size_t * nelems)226 pf_nvuint_32_array(const nvlist_t *nvl, const char *name, size_t maxelems,
227 uint32_t *numbers, size_t *nelems)
228 {
229 const uint64_t *tmp;
230 size_t elems;
231
232 tmp = nvlist_get_number_array(nvl, name, &elems);
233
234 for (size_t i = 0; i < elems && i < maxelems; i++)
235 numbers[i] = tmp[i];
236
237 if (nelems)
238 *nelems = elems;
239 }
240
241 static void
pf_nvuint_64_array(const nvlist_t * nvl,const char * name,size_t maxelems,uint64_t * numbers,size_t * nelems)242 pf_nvuint_64_array(const nvlist_t *nvl, const char *name, size_t maxelems,
243 uint64_t *numbers, size_t *nelems)
244 {
245 const uint64_t *tmp;
246 size_t elems;
247
248 tmp = nvlist_get_number_array(nvl, name, &elems);
249 assert(elems <= maxelems);
250
251 for (size_t i = 0; i < elems; i++)
252 numbers[i] = tmp[i];
253
254 if (nelems)
255 *nelems = elems;
256 }
257
258 int
pfctl_startstop(struct pfctl_handle * h,int start)259 pfctl_startstop(struct pfctl_handle *h, int start)
260 {
261 return (pfctl_do_netlink_cmd(h, start ? PFNL_CMD_START : PFNL_CMD_STOP));
262 }
263
264 static void
_pfctl_get_status_counters(const nvlist_t * nvl,struct pfctl_status_counters * counters)265 _pfctl_get_status_counters(const nvlist_t *nvl,
266 struct pfctl_status_counters *counters)
267 {
268 const uint64_t *ids, *counts;
269 const char *const *names;
270 size_t id_len, counter_len, names_len;
271
272 ids = nvlist_get_number_array(nvl, "ids", &id_len);
273 counts = nvlist_get_number_array(nvl, "counters", &counter_len);
274 names = nvlist_get_string_array(nvl, "names", &names_len);
275 assert(id_len == counter_len);
276 assert(counter_len == names_len);
277
278 TAILQ_INIT(counters);
279
280 for (size_t i = 0; i < id_len; i++) {
281 struct pfctl_status_counter *c;
282
283 c = malloc(sizeof(*c));
284 if (c == NULL)
285 continue;
286
287 c->id = ids[i];
288 c->counter = counts[i];
289 c->name = strdup(names[i]);
290
291 TAILQ_INSERT_TAIL(counters, c, entry);
292 }
293 }
294
295 #define _OUT(_field) offsetof(struct pfctl_status_counter, _field)
296 static const struct snl_attr_parser ap_counter[] = {
297 { .type = PF_C_COUNTER, .off = _OUT(counter), .cb = snl_attr_get_uint64 },
298 { .type = PF_C_NAME, .off = _OUT(name), .cb = snl_attr_get_string },
299 { .type = PF_C_ID, .off = _OUT(id), .cb = snl_attr_get_uint32 },
300 };
301 SNL_DECLARE_ATTR_PARSER(counter_parser, ap_counter);
302 #undef _OUT
303
304 static bool
snl_attr_get_counters(struct snl_state * ss,struct nlattr * nla,const void * arg __unused,void * target)305 snl_attr_get_counters(struct snl_state *ss, struct nlattr *nla,
306 const void *arg __unused, void *target)
307 {
308 struct pfctl_status_counter counter = {};
309 struct pfctl_status_counter *c;
310 bool error;
311
312 error = snl_parse_header(ss, NLA_DATA(nla), NLA_DATA_LEN(nla), &counter_parser, &counter);
313 if (! error)
314 return (error);
315
316 c = malloc(sizeof(*c));
317 if (c == NULL)
318 return (false);
319
320 c->id = counter.id;
321 c->counter = counter.counter;
322 c->name = strdup(counter.name);
323
324 TAILQ_INSERT_TAIL((struct pfctl_status_counters *)target, c, entry);
325
326 return (error);
327 }
328
329 struct snl_uint64_array {
330 uint64_t *array;
331 size_t count;
332 size_t max;
333 };
334 static bool
snl_attr_get_uint64_element(struct snl_state * ss,struct nlattr * nla,const void * arg,void * target)335 snl_attr_get_uint64_element(struct snl_state *ss, struct nlattr *nla,
336 const void *arg, void *target)
337 {
338 bool error;
339 uint64_t value;
340 struct snl_uint64_array *t = (struct snl_uint64_array *)target;
341
342 if (t->count >= t->max)
343 return (false);
344
345 error = snl_attr_get_uint64(ss, nla, arg, &value);
346 if (! error)
347 return (error);
348
349 t->array[t->count++] = value;
350
351 return (true);
352 }
353
354 static const struct snl_attr_parser ap_array[] = {
355 { .cb = snl_attr_get_uint64_element },
356 };
357 SNL_DECLARE_ATTR_PARSER(array_parser, ap_array);
358 static bool
snl_attr_get_uint64_array(struct snl_state * ss,struct nlattr * nla,const void * arg,void * target)359 snl_attr_get_uint64_array(struct snl_state *ss, struct nlattr *nla,
360 const void *arg, void *target)
361 {
362 struct snl_uint64_array a = {
363 .array = target,
364 .count = 0,
365 .max = (size_t)arg,
366 };
367 bool error;
368
369 error = snl_parse_header(ss, NLA_DATA(nla), NLA_DATA_LEN(nla), &array_parser, &a);
370 if (! error)
371 return (error);
372
373 return (true);
374 }
375
376 #define _OUT(_field) offsetof(struct pfctl_status, _field)
377 static const struct snl_attr_parser ap_getstatus[] = {
378 { .type = PF_GS_IFNAME, .off = _OUT(ifname), .arg_u32 = IFNAMSIZ, .cb = snl_attr_copy_string },
379 { .type = PF_GS_RUNNING, .off = _OUT(running), .cb = snl_attr_get_bool },
380 { .type = PF_GS_SINCE, .off = _OUT(since), .cb = snl_attr_get_uint32 },
381 { .type = PF_GS_DEBUG, .off = _OUT(debug), .cb = snl_attr_get_uint32 },
382 { .type = PF_GS_HOSTID, .off = _OUT(hostid), .cb = snl_attr_get_uint32 },
383 { .type = PF_GS_STATES, .off = _OUT(states), .cb = snl_attr_get_uint32 },
384 { .type = PF_GS_SRC_NODES, .off = _OUT(src_nodes), .cb = snl_attr_get_uint32 },
385 { .type = PF_GS_REASSEMBLE, .off = _OUT(reass), .cb = snl_attr_get_uint32 },
386 { .type = PF_GS_SYNCOOKIES_ACTIVE, .off = _OUT(syncookies_active), .cb = snl_attr_get_uint32 },
387 { .type = PF_GS_COUNTERS, .off = _OUT(counters), .cb = snl_attr_get_counters },
388 { .type = PF_GS_LCOUNTERS, .off = _OUT(lcounters), .cb = snl_attr_get_counters },
389 { .type = PF_GS_FCOUNTERS, .off = _OUT(fcounters), .cb = snl_attr_get_counters },
390 { .type = PF_GS_SCOUNTERS, .off = _OUT(scounters), .cb = snl_attr_get_counters },
391 { .type = PF_GS_CHKSUM, .off = _OUT(pf_chksum), .arg_u32 = PF_MD5_DIGEST_LENGTH, .cb = snl_attr_get_bytes },
392 { .type = PF_GS_BCOUNTERS, .off = _OUT(bcounters), .arg_u32 = 2 * 2, .cb = snl_attr_get_uint64_array },
393 { .type = PF_GS_PCOUNTERS, .off = _OUT(pcounters), .arg_u32 = 2 * 2 * 2, .cb = snl_attr_get_uint64_array },
394 };
395 SNL_DECLARE_PARSER(getstatus_parser, struct genlmsghdr, snl_f_p_empty, ap_getstatus);
396 #undef _OUT
397
398 struct pfctl_status *
pfctl_get_status_h(struct pfctl_handle * h)399 pfctl_get_status_h(struct pfctl_handle *h)
400 {
401 struct pfctl_status *status;
402 struct snl_errmsg_data e = {};
403 struct nlmsghdr *hdr;
404 struct snl_writer nw;
405 uint32_t seq_id;
406 int family_id;
407
408 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
409 if (family_id == 0)
410 return (NULL);
411
412 snl_init_writer(&h->ss, &nw);
413 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_GET_STATUS);
414 hdr->nlmsg_flags |= NLM_F_DUMP;
415
416 hdr = snl_finalize_msg(&nw);
417 if (hdr == NULL) {
418 return (NULL);
419 }
420
421 seq_id = hdr->nlmsg_seq;
422 if (! snl_send_message(&h->ss, hdr))
423 return (NULL);
424
425 status = calloc(1, sizeof(*status));
426 if (status == NULL)
427 return (NULL);
428 TAILQ_INIT(&status->counters);
429 TAILQ_INIT(&status->lcounters);
430 TAILQ_INIT(&status->fcounters);
431 TAILQ_INIT(&status->scounters);
432
433 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
434 if (! snl_parse_nlmsg(&h->ss, hdr, &getstatus_parser, status))
435 continue;
436 }
437
438 return (status);
439 }
440
441 struct pfctl_status *
pfctl_get_status(int dev)442 pfctl_get_status(int dev)
443 {
444 struct pfctl_status *status;
445 nvlist_t *nvl;
446 size_t len;
447 const void *chksum;
448
449 status = calloc(1, sizeof(*status));
450 if (status == NULL)
451 return (NULL);
452
453 nvl = nvlist_create(0);
454
455 if (pfctl_do_ioctl(dev, DIOCGETSTATUSNV, 4096, &nvl)) {
456 nvlist_destroy(nvl);
457 free(status);
458 return (NULL);
459 }
460
461 status->running = nvlist_get_bool(nvl, "running");
462 status->since = nvlist_get_number(nvl, "since");
463 status->debug = nvlist_get_number(nvl, "debug");
464 status->hostid = ntohl(nvlist_get_number(nvl, "hostid"));
465 status->states = nvlist_get_number(nvl, "states");
466 status->src_nodes = nvlist_get_number(nvl, "src_nodes");
467 status->syncookies_active = nvlist_get_bool(nvl, "syncookies_active");
468 status->reass = nvlist_get_number(nvl, "reass");
469
470 strlcpy(status->ifname, nvlist_get_string(nvl, "ifname"),
471 IFNAMSIZ);
472 chksum = nvlist_get_binary(nvl, "chksum", &len);
473 assert(len == PF_MD5_DIGEST_LENGTH);
474 memcpy(status->pf_chksum, chksum, len);
475
476 _pfctl_get_status_counters(nvlist_get_nvlist(nvl, "counters"),
477 &status->counters);
478 _pfctl_get_status_counters(nvlist_get_nvlist(nvl, "lcounters"),
479 &status->lcounters);
480 _pfctl_get_status_counters(nvlist_get_nvlist(nvl, "fcounters"),
481 &status->fcounters);
482 _pfctl_get_status_counters(nvlist_get_nvlist(nvl, "scounters"),
483 &status->scounters);
484
485 pf_nvuint_64_array(nvl, "pcounters", 2 * 2 * 2,
486 (uint64_t *)status->pcounters, NULL);
487 pf_nvuint_64_array(nvl, "bcounters", 2 * 2,
488 (uint64_t *)status->bcounters, NULL);
489
490 nvlist_destroy(nvl);
491
492 return (status);
493 }
494 int
pfctl_clear_status(struct pfctl_handle * h)495 pfctl_clear_status(struct pfctl_handle *h)
496 {
497 return (pfctl_do_netlink_cmd(h, PFNL_CMD_CLEAR_STATUS));
498 }
499
500 static uint64_t
_pfctl_status_counter(struct pfctl_status_counters * counters,uint64_t id)501 _pfctl_status_counter(struct pfctl_status_counters *counters, uint64_t id)
502 {
503 struct pfctl_status_counter *c;
504
505 TAILQ_FOREACH(c, counters, entry) {
506 if (c->id == id)
507 return (c->counter);
508 }
509
510 return (0);
511 }
512
513 uint64_t
pfctl_status_counter(struct pfctl_status * status,int id)514 pfctl_status_counter(struct pfctl_status *status, int id)
515 {
516 return (_pfctl_status_counter(&status->counters, id));
517 }
518
519 uint64_t
pfctl_status_lcounter(struct pfctl_status * status,int id)520 pfctl_status_lcounter(struct pfctl_status *status, int id)
521 {
522 return (_pfctl_status_counter(&status->lcounters, id));
523 }
524
525 uint64_t
pfctl_status_fcounter(struct pfctl_status * status,int id)526 pfctl_status_fcounter(struct pfctl_status *status, int id)
527 {
528 return (_pfctl_status_counter(&status->fcounters, id));
529 }
530
531 uint64_t
pfctl_status_scounter(struct pfctl_status * status,int id)532 pfctl_status_scounter(struct pfctl_status *status, int id)
533 {
534 return (_pfctl_status_counter(&status->scounters, id));
535 }
536
537 void
pfctl_free_status(struct pfctl_status * status)538 pfctl_free_status(struct pfctl_status *status)
539 {
540 struct pfctl_status_counter *c, *tmp;
541
542 if (status == NULL)
543 return;
544
545 TAILQ_FOREACH_SAFE(c, &status->counters, entry, tmp) {
546 free(c->name);
547 free(c);
548 }
549 TAILQ_FOREACH_SAFE(c, &status->lcounters, entry, tmp) {
550 free(c->name);
551 free(c);
552 }
553 TAILQ_FOREACH_SAFE(c, &status->fcounters, entry, tmp) {
554 free(c->name);
555 free(c);
556 }
557 TAILQ_FOREACH_SAFE(c, &status->scounters, entry, tmp) {
558 free(c->name);
559 free(c);
560 }
561
562 free(status);
563 }
564
565 static void
pfctl_nv_add_addr(nvlist_t * nvparent,const char * name,const struct pf_addr * addr)566 pfctl_nv_add_addr(nvlist_t *nvparent, const char *name,
567 const struct pf_addr *addr)
568 {
569 nvlist_t *nvl = nvlist_create(0);
570
571 nvlist_add_binary(nvl, "addr", addr, sizeof(*addr));
572
573 nvlist_add_nvlist(nvparent, name, nvl);
574 nvlist_destroy(nvl);
575 }
576
577 static void
pf_nvaddr_to_addr(const nvlist_t * nvl,struct pf_addr * addr)578 pf_nvaddr_to_addr(const nvlist_t *nvl, struct pf_addr *addr)
579 {
580 size_t len;
581 const void *data;
582
583 data = nvlist_get_binary(nvl, "addr", &len);
584 assert(len == sizeof(struct pf_addr));
585 memcpy(addr, data, len);
586 }
587
588 static void
pfctl_nv_add_addr_wrap(nvlist_t * nvparent,const char * name,const struct pf_addr_wrap * addr)589 pfctl_nv_add_addr_wrap(nvlist_t *nvparent, const char *name,
590 const struct pf_addr_wrap *addr)
591 {
592 nvlist_t *nvl = nvlist_create(0);
593
594 nvlist_add_number(nvl, "type", addr->type);
595 nvlist_add_number(nvl, "iflags", addr->iflags);
596 if (addr->type == PF_ADDR_DYNIFTL)
597 nvlist_add_string(nvl, "ifname", addr->v.ifname);
598 if (addr->type == PF_ADDR_TABLE)
599 nvlist_add_string(nvl, "tblname", addr->v.tblname);
600 pfctl_nv_add_addr(nvl, "addr", &addr->v.a.addr);
601 pfctl_nv_add_addr(nvl, "mask", &addr->v.a.mask);
602
603 nvlist_add_nvlist(nvparent, name, nvl);
604 nvlist_destroy(nvl);
605 }
606
607 static void
pf_nvaddr_wrap_to_addr_wrap(const nvlist_t * nvl,struct pf_addr_wrap * addr)608 pf_nvaddr_wrap_to_addr_wrap(const nvlist_t *nvl, struct pf_addr_wrap *addr)
609 {
610 bzero(addr, sizeof(*addr));
611
612 addr->type = nvlist_get_number(nvl, "type");
613 addr->iflags = nvlist_get_number(nvl, "iflags");
614 if (addr->type == PF_ADDR_DYNIFTL) {
615 strlcpy(addr->v.ifname, nvlist_get_string(nvl, "ifname"),
616 IFNAMSIZ);
617 addr->p.dyncnt = nvlist_get_number(nvl, "dyncnt");
618 }
619 if (addr->type == PF_ADDR_TABLE) {
620 strlcpy(addr->v.tblname, nvlist_get_string(nvl, "tblname"),
621 PF_TABLE_NAME_SIZE);
622 addr->p.tblcnt = nvlist_get_number(nvl, "tblcnt");
623 }
624
625 pf_nvaddr_to_addr(nvlist_get_nvlist(nvl, "addr"), &addr->v.a.addr);
626 pf_nvaddr_to_addr(nvlist_get_nvlist(nvl, "mask"), &addr->v.a.mask);
627 }
628
629 static void
pfctl_nv_add_rule_addr(nvlist_t * nvparent,const char * name,const struct pf_rule_addr * addr)630 pfctl_nv_add_rule_addr(nvlist_t *nvparent, const char *name,
631 const struct pf_rule_addr *addr)
632 {
633 uint64_t ports[2];
634 nvlist_t *nvl = nvlist_create(0);
635
636 pfctl_nv_add_addr_wrap(nvl, "addr", &addr->addr);
637 ports[0] = addr->port[0];
638 ports[1] = addr->port[1];
639 nvlist_add_number_array(nvl, "port", ports, 2);
640 nvlist_add_number(nvl, "neg", addr->neg);
641 nvlist_add_number(nvl, "port_op", addr->port_op);
642
643 nvlist_add_nvlist(nvparent, name, nvl);
644 nvlist_destroy(nvl);
645 }
646
647 static void
pf_nvrule_addr_to_rule_addr(const nvlist_t * nvl,struct pf_rule_addr * addr)648 pf_nvrule_addr_to_rule_addr(const nvlist_t *nvl, struct pf_rule_addr *addr)
649 {
650 pf_nvaddr_wrap_to_addr_wrap(nvlist_get_nvlist(nvl, "addr"), &addr->addr);
651
652 pf_nvuint_16_array(nvl, "port", 2, addr->port, NULL);
653 addr->neg = nvlist_get_number(nvl, "neg");
654 addr->port_op = nvlist_get_number(nvl, "port_op");
655 }
656
657 static void
pf_nvmape_to_mape(const nvlist_t * nvl,struct pf_mape_portset * mape)658 pf_nvmape_to_mape(const nvlist_t *nvl, struct pf_mape_portset *mape)
659 {
660 mape->offset = nvlist_get_number(nvl, "offset");
661 mape->psidlen = nvlist_get_number(nvl, "psidlen");
662 mape->psid = nvlist_get_number(nvl, "psid");
663 }
664
665 static void
pf_nvpool_to_pool(const nvlist_t * nvl,struct pfctl_pool * pool)666 pf_nvpool_to_pool(const nvlist_t *nvl, struct pfctl_pool *pool)
667 {
668 size_t len;
669 const void *data;
670
671 data = nvlist_get_binary(nvl, "key", &len);
672 assert(len == sizeof(pool->key));
673 memcpy(&pool->key, data, len);
674
675 pf_nvaddr_to_addr(nvlist_get_nvlist(nvl, "counter"), &pool->counter);
676
677 pool->tblidx = nvlist_get_number(nvl, "tblidx");
678 pf_nvuint_16_array(nvl, "proxy_port", 2, pool->proxy_port, NULL);
679 pool->opts = nvlist_get_number(nvl, "opts");
680
681 if (nvlist_exists_nvlist(nvl, "mape"))
682 pf_nvmape_to_mape(nvlist_get_nvlist(nvl, "mape"), &pool->mape);
683 }
684
685 static void
pf_nvrule_uid_to_rule_uid(const nvlist_t * nvl,struct pf_rule_uid * uid)686 pf_nvrule_uid_to_rule_uid(const nvlist_t *nvl, struct pf_rule_uid *uid)
687 {
688 pf_nvuint_32_array(nvl, "uid", 2, uid->uid, NULL);
689 uid->op = nvlist_get_number(nvl, "op");
690 }
691
692 static void
pf_nvdivert_to_divert(const nvlist_t * nvl,struct pfctl_rule * rule)693 pf_nvdivert_to_divert(const nvlist_t *nvl, struct pfctl_rule *rule)
694 {
695 pf_nvaddr_to_addr(nvlist_get_nvlist(nvl, "addr"), &rule->divert.addr);
696 rule->divert.port = nvlist_get_number(nvl, "port");
697 }
698
699 static void
pf_nvrule_to_rule(const nvlist_t * nvl,struct pfctl_rule * rule)700 pf_nvrule_to_rule(const nvlist_t *nvl, struct pfctl_rule *rule)
701 {
702 const uint64_t *skip;
703 const char *const *labels;
704 size_t skipcount, labelcount;
705
706 rule->nr = nvlist_get_number(nvl, "nr");
707
708 pf_nvrule_addr_to_rule_addr(nvlist_get_nvlist(nvl, "src"), &rule->src);
709 pf_nvrule_addr_to_rule_addr(nvlist_get_nvlist(nvl, "dst"), &rule->dst);
710
711 skip = nvlist_get_number_array(nvl, "skip", &skipcount);
712 assert(skip);
713 assert(skipcount == PF_SKIP_COUNT);
714 for (int i = 0; i < PF_SKIP_COUNT; i++)
715 rule->skip[i].nr = skip[i];
716
717 labels = nvlist_get_string_array(nvl, "labels", &labelcount);
718 assert(labelcount <= PF_RULE_MAX_LABEL_COUNT);
719 for (size_t i = 0; i < labelcount; i++)
720 strlcpy(rule->label[i], labels[i], PF_RULE_LABEL_SIZE);
721 rule->ridentifier = nvlist_get_number(nvl, "ridentifier");
722 strlcpy(rule->ifname, nvlist_get_string(nvl, "ifname"), IFNAMSIZ);
723 strlcpy(rule->qname, nvlist_get_string(nvl, "qname"), PF_QNAME_SIZE);
724 strlcpy(rule->pqname, nvlist_get_string(nvl, "pqname"), PF_QNAME_SIZE);
725 strlcpy(rule->tagname, nvlist_get_string(nvl, "tagname"),
726 PF_TAG_NAME_SIZE);
727 strlcpy(rule->match_tagname, nvlist_get_string(nvl, "match_tagname"),
728 PF_TAG_NAME_SIZE);
729
730 strlcpy(rule->overload_tblname, nvlist_get_string(nvl, "overload_tblname"),
731 PF_TABLE_NAME_SIZE);
732
733 pf_nvpool_to_pool(nvlist_get_nvlist(nvl, "rpool"), &rule->rdr);
734
735 rule->evaluations = nvlist_get_number(nvl, "evaluations");
736 pf_nvuint_64_array(nvl, "packets", 2, rule->packets, NULL);
737 pf_nvuint_64_array(nvl, "bytes", 2, rule->bytes, NULL);
738
739 if (nvlist_exists_number(nvl, "timestamp")) {
740 rule->last_active_timestamp = nvlist_get_number(nvl, "timestamp");
741 }
742
743 rule->os_fingerprint = nvlist_get_number(nvl, "os_fingerprint");
744
745 rule->rtableid = nvlist_get_number(nvl, "rtableid");
746 pf_nvuint_32_array(nvl, "timeout", PFTM_MAX, rule->timeout, NULL);
747 rule->max_states = nvlist_get_number(nvl, "max_states");
748 rule->max_src_nodes = nvlist_get_number(nvl, "max_src_nodes");
749 rule->max_src_states = nvlist_get_number(nvl, "max_src_states");
750 rule->max_src_conn = nvlist_get_number(nvl, "max_src_conn");
751 rule->max_src_conn_rate.limit =
752 nvlist_get_number(nvl, "max_src_conn_rate.limit");
753 rule->max_src_conn_rate.seconds =
754 nvlist_get_number(nvl, "max_src_conn_rate.seconds");
755 rule->qid = nvlist_get_number(nvl, "qid");
756 rule->pqid = nvlist_get_number(nvl, "pqid");
757 rule->dnpipe = nvlist_get_number(nvl, "dnpipe");
758 rule->dnrpipe = nvlist_get_number(nvl, "dnrpipe");
759 rule->free_flags = nvlist_get_number(nvl, "dnflags");
760 rule->prob = nvlist_get_number(nvl, "prob");
761 rule->cuid = nvlist_get_number(nvl, "cuid");
762 rule->cpid = nvlist_get_number(nvl, "cpid");
763
764 rule->return_icmp = nvlist_get_number(nvl, "return_icmp");
765 rule->return_icmp6 = nvlist_get_number(nvl, "return_icmp6");
766 rule->max_mss = nvlist_get_number(nvl, "max_mss");
767 rule->scrub_flags = nvlist_get_number(nvl, "scrub_flags");
768
769 pf_nvrule_uid_to_rule_uid(nvlist_get_nvlist(nvl, "uid"), &rule->uid);
770 pf_nvrule_uid_to_rule_uid(nvlist_get_nvlist(nvl, "gid"),
771 (struct pf_rule_uid *)&rule->gid);
772
773 rule->rule_flag = nvlist_get_number(nvl, "rule_flag");
774 rule->action = nvlist_get_number(nvl, "action");
775 rule->direction = nvlist_get_number(nvl, "direction");
776 rule->log = nvlist_get_number(nvl, "log");
777 rule->logif = nvlist_get_number(nvl, "logif");
778 rule->quick = nvlist_get_number(nvl, "quick");
779 rule->ifnot = nvlist_get_number(nvl, "ifnot");
780 rule->match_tag_not = nvlist_get_number(nvl, "match_tag_not");
781 rule->natpass = nvlist_get_number(nvl, "natpass");
782
783 rule->keep_state = nvlist_get_number(nvl, "keep_state");
784 rule->af = nvlist_get_number(nvl, "af");
785 rule->proto = nvlist_get_number(nvl, "proto");
786 rule->type = nvlist_get_number(nvl, "type");
787 rule->code = nvlist_get_number(nvl, "code");
788 rule->flags = nvlist_get_number(nvl, "flags");
789 rule->flagset = nvlist_get_number(nvl, "flagset");
790 rule->min_ttl = nvlist_get_number(nvl, "min_ttl");
791 rule->allow_opts = nvlist_get_number(nvl, "allow_opts");
792 rule->rt = nvlist_get_number(nvl, "rt");
793 rule->return_ttl = nvlist_get_number(nvl, "return_ttl");
794 rule->tos = nvlist_get_number(nvl, "tos");
795 rule->set_tos = nvlist_get_number(nvl, "set_tos");
796 rule->anchor_relative = nvlist_get_number(nvl, "anchor_relative");
797 rule->anchor_wildcard = nvlist_get_number(nvl, "anchor_wildcard");
798
799 rule->flush = nvlist_get_number(nvl, "flush");
800 rule->prio = nvlist_get_number(nvl, "prio");
801 pf_nvuint_8_array(nvl, "set_prio", 2, rule->set_prio, NULL);
802
803 pf_nvdivert_to_divert(nvlist_get_nvlist(nvl, "divert"), rule);
804
805 rule->states_cur = nvlist_get_number(nvl, "states_cur");
806 rule->states_tot = nvlist_get_number(nvl, "states_tot");
807 rule->src_nodes = nvlist_get_number(nvl, "src_nodes");
808 }
809
810 static void
pfctl_nveth_addr_to_eth_addr(const nvlist_t * nvl,struct pfctl_eth_addr * addr)811 pfctl_nveth_addr_to_eth_addr(const nvlist_t *nvl, struct pfctl_eth_addr *addr)
812 {
813 static const u_int8_t EMPTY_MAC[ETHER_ADDR_LEN] = { 0 };
814 size_t len;
815 const void *data;
816
817 data = nvlist_get_binary(nvl, "addr", &len);
818 assert(len == sizeof(addr->addr));
819 memcpy(addr->addr, data, sizeof(addr->addr));
820
821 data = nvlist_get_binary(nvl, "mask", &len);
822 assert(len == sizeof(addr->mask));
823 memcpy(addr->mask, data, sizeof(addr->mask));
824
825 addr->neg = nvlist_get_bool(nvl, "neg");
826
827 /* To make checks for 'is this address set?' easier. */
828 addr->isset = memcmp(addr->addr, EMPTY_MAC, ETHER_ADDR_LEN) != 0;
829 }
830
831 static nvlist_t *
pfctl_eth_addr_to_nveth_addr(const struct pfctl_eth_addr * addr)832 pfctl_eth_addr_to_nveth_addr(const struct pfctl_eth_addr *addr)
833 {
834 nvlist_t *nvl;
835
836 nvl = nvlist_create(0);
837 if (nvl == NULL)
838 return (NULL);
839
840 nvlist_add_bool(nvl, "neg", addr->neg);
841 nvlist_add_binary(nvl, "addr", &addr->addr, ETHER_ADDR_LEN);
842 nvlist_add_binary(nvl, "mask", &addr->mask, ETHER_ADDR_LEN);
843
844 return (nvl);
845 }
846
847 static void
pfctl_nveth_rule_to_eth_rule(const nvlist_t * nvl,struct pfctl_eth_rule * rule)848 pfctl_nveth_rule_to_eth_rule(const nvlist_t *nvl, struct pfctl_eth_rule *rule)
849 {
850 const char *const *labels;
851 size_t labelcount, i;
852
853 rule->nr = nvlist_get_number(nvl, "nr");
854 rule->quick = nvlist_get_bool(nvl, "quick");
855 strlcpy(rule->ifname, nvlist_get_string(nvl, "ifname"), IFNAMSIZ);
856 rule->ifnot = nvlist_get_bool(nvl, "ifnot");
857 rule->direction = nvlist_get_number(nvl, "direction");
858 rule->proto = nvlist_get_number(nvl, "proto");
859 strlcpy(rule->match_tagname, nvlist_get_string(nvl, "match_tagname"),
860 PF_TAG_NAME_SIZE);
861 rule->match_tag = nvlist_get_number(nvl, "match_tag");
862 rule->match_tag_not = nvlist_get_bool(nvl, "match_tag_not");
863
864 labels = nvlist_get_string_array(nvl, "labels", &labelcount);
865 assert(labelcount <= PF_RULE_MAX_LABEL_COUNT);
866 for (i = 0; i < labelcount; i++)
867 strlcpy(rule->label[i], labels[i], PF_RULE_LABEL_SIZE);
868 rule->ridentifier = nvlist_get_number(nvl, "ridentifier");
869
870 pfctl_nveth_addr_to_eth_addr(nvlist_get_nvlist(nvl, "src"),
871 &rule->src);
872 pfctl_nveth_addr_to_eth_addr(nvlist_get_nvlist(nvl, "dst"),
873 &rule->dst);
874
875 pf_nvrule_addr_to_rule_addr(nvlist_get_nvlist(nvl, "ipsrc"),
876 &rule->ipsrc);
877 pf_nvrule_addr_to_rule_addr(nvlist_get_nvlist(nvl, "ipdst"),
878 &rule->ipdst);
879
880 rule->evaluations = nvlist_get_number(nvl, "evaluations");
881 rule->packets[0] = nvlist_get_number(nvl, "packets-in");
882 rule->packets[1] = nvlist_get_number(nvl, "packets-out");
883 rule->bytes[0] = nvlist_get_number(nvl, "bytes-in");
884 rule->bytes[1] = nvlist_get_number(nvl, "bytes-out");
885
886 if (nvlist_exists_number(nvl, "timestamp")) {
887 rule->last_active_timestamp = nvlist_get_number(nvl, "timestamp");
888 }
889
890 strlcpy(rule->qname, nvlist_get_string(nvl, "qname"), PF_QNAME_SIZE);
891 strlcpy(rule->tagname, nvlist_get_string(nvl, "tagname"),
892 PF_TAG_NAME_SIZE);
893
894 rule->dnpipe = nvlist_get_number(nvl, "dnpipe");
895 rule->dnflags = nvlist_get_number(nvl, "dnflags");
896
897 rule->anchor_relative = nvlist_get_number(nvl, "anchor_relative");
898 rule->anchor_wildcard = nvlist_get_number(nvl, "anchor_wildcard");
899
900 strlcpy(rule->bridge_to, nvlist_get_string(nvl, "bridge_to"),
901 IFNAMSIZ);
902
903 rule->action = nvlist_get_number(nvl, "action");
904 }
905
906 int
pfctl_get_eth_rulesets_info(int dev,struct pfctl_eth_rulesets_info * ri,const char * path)907 pfctl_get_eth_rulesets_info(int dev, struct pfctl_eth_rulesets_info *ri,
908 const char *path)
909 {
910 nvlist_t *nvl;
911 int ret;
912
913 bzero(ri, sizeof(*ri));
914
915 nvl = nvlist_create(0);
916 nvlist_add_string(nvl, "path", path);
917
918 if ((ret = pfctl_do_ioctl(dev, DIOCGETETHRULESETS, 256, &nvl)) != 0)
919 goto out;
920
921 ri->nr = nvlist_get_number(nvl, "nr");
922
923 out:
924 nvlist_destroy(nvl);
925 return (ret);
926 }
927
928 int
pfctl_get_eth_ruleset(int dev,const char * path,int nr,struct pfctl_eth_ruleset_info * ri)929 pfctl_get_eth_ruleset(int dev, const char *path, int nr,
930 struct pfctl_eth_ruleset_info *ri)
931 {
932 nvlist_t *nvl;
933 int ret;
934
935 bzero(ri, sizeof(*ri));
936
937 nvl = nvlist_create(0);
938 nvlist_add_string(nvl, "path", path);
939 nvlist_add_number(nvl, "nr", nr);
940
941 if ((ret = pfctl_do_ioctl(dev, DIOCGETETHRULESET, 1024, &nvl)) != 0)
942 goto out;
943
944 ri->nr = nvlist_get_number(nvl, "nr");
945 strlcpy(ri->path, nvlist_get_string(nvl, "path"), MAXPATHLEN);
946 strlcpy(ri->name, nvlist_get_string(nvl, "name"),
947 PF_ANCHOR_NAME_SIZE);
948
949 out:
950 nvlist_destroy(nvl);
951 return (ret);
952 }
953
954 int
pfctl_get_eth_rules_info(int dev,struct pfctl_eth_rules_info * rules,const char * path)955 pfctl_get_eth_rules_info(int dev, struct pfctl_eth_rules_info *rules,
956 const char *path)
957 {
958 nvlist_t *nvl;
959 int ret;
960
961 bzero(rules, sizeof(*rules));
962
963 nvl = nvlist_create(0);
964 nvlist_add_string(nvl, "anchor", path);
965
966 if ((ret = pfctl_do_ioctl(dev, DIOCGETETHRULES, 1024, &nvl)) != 0)
967 goto out;
968
969 rules->nr = nvlist_get_number(nvl, "nr");
970 rules->ticket = nvlist_get_number(nvl, "ticket");
971
972 out:
973 nvlist_destroy(nvl);
974 return (ret);
975 }
976
977 int
pfctl_get_eth_rule(int dev,uint32_t nr,uint32_t ticket,const char * path,struct pfctl_eth_rule * rule,bool clear,char * anchor_call)978 pfctl_get_eth_rule(int dev, uint32_t nr, uint32_t ticket,
979 const char *path, struct pfctl_eth_rule *rule, bool clear,
980 char *anchor_call)
981 {
982 nvlist_t *nvl;
983 int ret;
984
985 nvl = nvlist_create(0);
986
987 nvlist_add_string(nvl, "anchor", path);
988 nvlist_add_number(nvl, "ticket", ticket);
989 nvlist_add_number(nvl, "nr", nr);
990 nvlist_add_bool(nvl, "clear", clear);
991
992 if ((ret = pfctl_do_ioctl(dev, DIOCGETETHRULE, 4096, &nvl)) != 0)
993 goto out;
994
995 pfctl_nveth_rule_to_eth_rule(nvl, rule);
996
997 if (anchor_call)
998 strlcpy(anchor_call, nvlist_get_string(nvl, "anchor_call"),
999 MAXPATHLEN);
1000
1001 out:
1002 nvlist_destroy(nvl);
1003 return (ret);
1004 }
1005
1006 int
pfctl_add_eth_rule(int dev,const struct pfctl_eth_rule * r,const char * anchor,const char * anchor_call,uint32_t ticket)1007 pfctl_add_eth_rule(int dev, const struct pfctl_eth_rule *r, const char *anchor,
1008 const char *anchor_call, uint32_t ticket)
1009 {
1010 struct pfioc_nv nv;
1011 nvlist_t *nvl, *addr;
1012 void *packed;
1013 int error = 0;
1014 size_t labelcount, size;
1015
1016 nvl = nvlist_create(0);
1017
1018 nvlist_add_number(nvl, "ticket", ticket);
1019 nvlist_add_string(nvl, "anchor", anchor);
1020 nvlist_add_string(nvl, "anchor_call", anchor_call);
1021
1022 nvlist_add_number(nvl, "nr", r->nr);
1023 nvlist_add_bool(nvl, "quick", r->quick);
1024 nvlist_add_string(nvl, "ifname", r->ifname);
1025 nvlist_add_bool(nvl, "ifnot", r->ifnot);
1026 nvlist_add_number(nvl, "direction", r->direction);
1027 nvlist_add_number(nvl, "proto", r->proto);
1028 nvlist_add_string(nvl, "match_tagname", r->match_tagname);
1029 nvlist_add_bool(nvl, "match_tag_not", r->match_tag_not);
1030
1031 addr = pfctl_eth_addr_to_nveth_addr(&r->src);
1032 if (addr == NULL) {
1033 nvlist_destroy(nvl);
1034 return (ENOMEM);
1035 }
1036 nvlist_add_nvlist(nvl, "src", addr);
1037 nvlist_destroy(addr);
1038
1039 addr = pfctl_eth_addr_to_nveth_addr(&r->dst);
1040 if (addr == NULL) {
1041 nvlist_destroy(nvl);
1042 return (ENOMEM);
1043 }
1044 nvlist_add_nvlist(nvl, "dst", addr);
1045 nvlist_destroy(addr);
1046
1047 pfctl_nv_add_rule_addr(nvl, "ipsrc", &r->ipsrc);
1048 pfctl_nv_add_rule_addr(nvl, "ipdst", &r->ipdst);
1049
1050 labelcount = 0;
1051 while (labelcount < PF_RULE_MAX_LABEL_COUNT &&
1052 r->label[labelcount][0] != 0) {
1053 nvlist_append_string_array(nvl, "labels",
1054 r->label[labelcount]);
1055 labelcount++;
1056 }
1057 nvlist_add_number(nvl, "ridentifier", r->ridentifier);
1058
1059 nvlist_add_string(nvl, "qname", r->qname);
1060 nvlist_add_string(nvl, "tagname", r->tagname);
1061 nvlist_add_number(nvl, "dnpipe", r->dnpipe);
1062 nvlist_add_number(nvl, "dnflags", r->dnflags);
1063
1064 nvlist_add_string(nvl, "bridge_to", r->bridge_to);
1065
1066 nvlist_add_number(nvl, "action", r->action);
1067
1068 packed = nvlist_pack(nvl, &size);
1069 if (packed == NULL) {
1070 nvlist_destroy(nvl);
1071 return (ENOMEM);
1072 }
1073
1074 nv.len = size;
1075 nv.size = size;
1076 nv.data = packed;
1077
1078 if (ioctl(dev, DIOCADDETHRULE, &nv) != 0)
1079 error = errno;
1080
1081 free(packed);
1082 nvlist_destroy(nvl);
1083
1084 return (error);
1085 }
1086
1087 static void
snl_add_msg_attr_addr_wrap(struct snl_writer * nw,uint32_t type,const struct pf_addr_wrap * addr)1088 snl_add_msg_attr_addr_wrap(struct snl_writer *nw, uint32_t type, const struct pf_addr_wrap *addr)
1089 {
1090 int off;
1091
1092 off = snl_add_msg_attr_nested(nw, type);
1093
1094 snl_add_msg_attr_ip6(nw, PF_AT_ADDR, &addr->v.a.addr.v6);
1095 snl_add_msg_attr_ip6(nw, PF_AT_MASK, &addr->v.a.mask.v6);
1096
1097 if (addr->type == PF_ADDR_DYNIFTL)
1098 snl_add_msg_attr_string(nw, PF_AT_IFNAME, addr->v.ifname);
1099 if (addr->type == PF_ADDR_TABLE)
1100 snl_add_msg_attr_string(nw, PF_AT_TABLENAME, addr->v.tblname);
1101 snl_add_msg_attr_u8(nw, PF_AT_TYPE, addr->type);
1102 snl_add_msg_attr_u8(nw, PF_AT_IFLAGS, addr->iflags);
1103
1104 snl_end_attr_nested(nw, off);
1105 }
1106
1107 static void
snl_add_msg_attr_pool_addr(struct snl_writer * nw,uint32_t type,const struct pf_pooladdr * pa)1108 snl_add_msg_attr_pool_addr(struct snl_writer *nw, uint32_t type, const struct pf_pooladdr *pa)
1109 {
1110 int off;
1111
1112 off = snl_add_msg_attr_nested(nw, type);
1113
1114 snl_add_msg_attr_string(nw, PF_PA_IFNAME, pa->ifname);
1115 snl_add_msg_attr_addr_wrap(nw, PF_PA_ADDR, &pa->addr);
1116
1117 snl_end_attr_nested(nw, off);
1118 }
1119
1120 static void
snl_add_msg_attr_rule_addr(struct snl_writer * nw,uint32_t type,const struct pf_rule_addr * addr)1121 snl_add_msg_attr_rule_addr(struct snl_writer *nw, uint32_t type, const struct pf_rule_addr *addr)
1122 {
1123 int off;
1124
1125 off = snl_add_msg_attr_nested(nw, type);
1126
1127 snl_add_msg_attr_addr_wrap(nw, PF_RAT_ADDR, &addr->addr);
1128 snl_add_msg_attr_u16(nw, PF_RAT_SRC_PORT, addr->port[0]);
1129 snl_add_msg_attr_u16(nw, PF_RAT_DST_PORT, addr->port[1]);
1130 snl_add_msg_attr_u8(nw, PF_RAT_NEG, addr->neg);
1131 snl_add_msg_attr_u8(nw, PF_RAT_OP, addr->port_op);
1132
1133 snl_end_attr_nested(nw, off);
1134 }
1135
1136 static void
snl_add_msg_attr_rule_labels(struct snl_writer * nw,uint32_t type,const char labels[PF_RULE_MAX_LABEL_COUNT][PF_RULE_LABEL_SIZE])1137 snl_add_msg_attr_rule_labels(struct snl_writer *nw, uint32_t type, const char labels[PF_RULE_MAX_LABEL_COUNT][PF_RULE_LABEL_SIZE])
1138 {
1139 int off, i = 0;
1140
1141 off = snl_add_msg_attr_nested(nw, type);
1142
1143 while (i < PF_RULE_MAX_LABEL_COUNT &&
1144 labels[i][0] != 0) {
1145 snl_add_msg_attr_string(nw, PF_LT_LABEL, labels[i]);
1146 i++;
1147 }
1148
1149 snl_end_attr_nested(nw, off);
1150 }
1151
1152 static void
snl_add_msg_attr_mape(struct snl_writer * nw,uint32_t type,const struct pf_mape_portset * me)1153 snl_add_msg_attr_mape(struct snl_writer *nw, uint32_t type, const struct pf_mape_portset *me)
1154 {
1155 int off;
1156
1157 off = snl_add_msg_attr_nested(nw, type);
1158
1159 snl_add_msg_attr_u8(nw, PF_MET_OFFSET, me->offset);
1160 snl_add_msg_attr_u8(nw, PF_MET_PSID_LEN, me->psidlen);
1161 snl_add_msg_attr_u16(nw, PF_MET_PSID, me->psid);
1162
1163 snl_end_attr_nested(nw, off);
1164 }
1165
1166 static void
snl_add_msg_attr_rpool(struct snl_writer * nw,uint32_t type,const struct pfctl_pool * pool)1167 snl_add_msg_attr_rpool(struct snl_writer *nw, uint32_t type, const struct pfctl_pool *pool)
1168 {
1169 int off;
1170
1171 off = snl_add_msg_attr_nested(nw, type);
1172
1173 snl_add_msg_attr(nw, PF_PT_KEY, sizeof(pool->key), &pool->key);
1174 snl_add_msg_attr_ip6(nw, PF_PT_COUNTER, &pool->counter.v6);
1175 snl_add_msg_attr_u32(nw, PF_PT_TBLIDX, pool->tblidx);
1176 snl_add_msg_attr_u16(nw, PF_PT_PROXY_SRC_PORT, pool->proxy_port[0]);
1177 snl_add_msg_attr_u16(nw, PF_PT_PROXY_DST_PORT, pool->proxy_port[1]);
1178 snl_add_msg_attr_u8(nw, PF_PT_OPTS, pool->opts);
1179 snl_add_msg_attr_mape(nw, PF_PT_MAPE, &pool->mape);
1180
1181 snl_end_attr_nested(nw, off);
1182 }
1183
1184 static void
snl_add_msg_attr_timeouts(struct snl_writer * nw,uint32_t type,const uint32_t * timeouts)1185 snl_add_msg_attr_timeouts(struct snl_writer *nw, uint32_t type, const uint32_t *timeouts)
1186 {
1187 int off;
1188
1189 off = snl_add_msg_attr_nested(nw, type);
1190
1191 for (int i = 0; i < PFTM_MAX; i++)
1192 snl_add_msg_attr_u32(nw, PF_TT_TIMEOUT, timeouts[i]);
1193
1194 snl_end_attr_nested(nw, off);
1195 }
1196
1197 static void
snl_add_msg_attr_uid(struct snl_writer * nw,uint32_t type,const struct pf_rule_uid * uid)1198 snl_add_msg_attr_uid(struct snl_writer *nw, uint32_t type, const struct pf_rule_uid *uid)
1199 {
1200 int off;
1201
1202 off = snl_add_msg_attr_nested(nw, type);
1203
1204 snl_add_msg_attr_u32(nw, PF_RUT_UID_LOW, uid->uid[0]);
1205 snl_add_msg_attr_u32(nw, PF_RUT_UID_HIGH, uid->uid[1]);
1206 snl_add_msg_attr_u8(nw, PF_RUT_OP, uid->op);
1207
1208 snl_end_attr_nested(nw, off);
1209 }
1210
1211 static void
snl_add_msg_attr_threshold(struct snl_writer * nw,uint32_t type,const struct pfctl_threshold * th)1212 snl_add_msg_attr_threshold(struct snl_writer *nw, uint32_t type, const struct pfctl_threshold *th)
1213 {
1214 int off;
1215
1216 off = snl_add_msg_attr_nested(nw, type);
1217
1218 snl_add_msg_attr_u32(nw, PF_TH_LIMIT, th->limit);
1219 snl_add_msg_attr_u32(nw, PF_TH_SECONDS, th->seconds);
1220
1221 snl_end_attr_nested(nw, off);
1222 }
1223
1224 static void
snl_add_msg_attr_pf_rule(struct snl_writer * nw,uint32_t type,const struct pfctl_rule * r)1225 snl_add_msg_attr_pf_rule(struct snl_writer *nw, uint32_t type, const struct pfctl_rule *r)
1226 {
1227 int off;
1228
1229 off = snl_add_msg_attr_nested(nw, type);
1230
1231 snl_add_msg_attr_rule_addr(nw, PF_RT_SRC, &r->src);
1232 snl_add_msg_attr_rule_addr(nw, PF_RT_DST, &r->dst);
1233 snl_add_msg_attr_rule_labels(nw, PF_RT_LABELS, r->label);
1234 snl_add_msg_attr_u32(nw, PF_RT_RIDENTIFIER, r->ridentifier);
1235 snl_add_msg_attr_string(nw, PF_RT_IFNAME, r->ifname);
1236 snl_add_msg_attr_string(nw, PF_RT_QNAME, r->qname);
1237 snl_add_msg_attr_string(nw, PF_RT_PQNAME, r->pqname);
1238 snl_add_msg_attr_string(nw, PF_RT_TAGNAME, r->tagname);
1239 snl_add_msg_attr_string(nw, PF_RT_MATCH_TAGNAME, r->match_tagname);
1240 snl_add_msg_attr_string(nw, PF_RT_OVERLOAD_TBLNAME, r->overload_tblname);
1241 snl_add_msg_attr_rpool(nw, PF_RT_RPOOL_RDR, &r->rdr);
1242 snl_add_msg_attr_rpool(nw, PF_RT_RPOOL_NAT, &r->nat);
1243 snl_add_msg_attr_rpool(nw, PF_RT_RPOOL_RT, &r->route);
1244 snl_add_msg_attr_threshold(nw, PF_RT_PKTRATE, &r->pktrate);
1245 snl_add_msg_attr_u32(nw, PF_RT_OS_FINGERPRINT, r->os_fingerprint);
1246 snl_add_msg_attr_u32(nw, PF_RT_RTABLEID, r->rtableid);
1247 snl_add_msg_attr_timeouts(nw, PF_RT_TIMEOUT, r->timeout);
1248 snl_add_msg_attr_u32(nw, PF_RT_MAX_STATES, r->max_states);
1249 snl_add_msg_attr_u32(nw, PF_RT_MAX_SRC_NODES, r->max_src_nodes);
1250 snl_add_msg_attr_u32(nw, PF_RT_MAX_SRC_STATES, r->max_src_states);
1251 snl_add_msg_attr_u32(nw, PF_RT_MAX_SRC_CONN, r->max_src_conn);
1252 snl_add_msg_attr_u32(nw, PF_RT_MAX_SRC_CONN_RATE_LIMIT, r->max_src_conn_rate.limit);
1253 snl_add_msg_attr_u32(nw, PF_RT_MAX_SRC_CONN_RATE_SECS, r->max_src_conn_rate.seconds);
1254 snl_add_msg_attr_u16(nw, PF_RT_MAX_PKT_SIZE, r->max_pkt_size);
1255
1256 snl_add_msg_attr_u16(nw, PF_RT_DNPIPE, r->dnpipe);
1257 snl_add_msg_attr_u16(nw, PF_RT_DNRPIPE, r->dnrpipe);
1258 snl_add_msg_attr_u32(nw, PF_RT_DNFLAGS, r->free_flags);
1259
1260 snl_add_msg_attr_u32(nw, PF_RT_NR, r->nr);
1261 snl_add_msg_attr_u32(nw, PF_RT_PROB, r->prob);
1262 snl_add_msg_attr_u32(nw, PF_RT_CUID, r->cuid);
1263 snl_add_msg_attr_u32(nw, PF_RT_CPID, r->cpid);
1264
1265 snl_add_msg_attr_u16(nw, PF_RT_RETURN_ICMP, r->return_icmp);
1266 snl_add_msg_attr_u16(nw, PF_RT_RETURN_ICMP6, r->return_icmp6);
1267 snl_add_msg_attr_u16(nw, PF_RT_MAX_MSS, r->max_mss);
1268 snl_add_msg_attr_u16(nw, PF_RT_SCRUB_FLAGS, r->scrub_flags);
1269
1270 snl_add_msg_attr_uid(nw, PF_RT_UID, &r->uid);
1271 snl_add_msg_attr_uid(nw, PF_RT_GID, (const struct pf_rule_uid *)&r->gid);
1272 snl_add_msg_attr_string(nw, PF_RT_RCV_IFNAME, r->rcv_ifname);
1273 snl_add_msg_attr_bool(nw, PF_RT_RCV_IFNOT, r->rcvifnot);
1274
1275 snl_add_msg_attr_u32(nw, PF_RT_RULE_FLAG, r->rule_flag);
1276 snl_add_msg_attr_u8(nw, PF_RT_ACTION, r->action);
1277 snl_add_msg_attr_u8(nw, PF_RT_DIRECTION, r->direction);
1278 snl_add_msg_attr_u8(nw, PF_RT_LOG, r->log);
1279 snl_add_msg_attr_u8(nw, PF_RT_LOGIF, r->logif);
1280 snl_add_msg_attr_u8(nw, PF_RT_QUICK, r->quick);
1281 snl_add_msg_attr_u8(nw, PF_RT_IF_NOT, r->ifnot);
1282 snl_add_msg_attr_u8(nw, PF_RT_MATCH_TAG_NOT, r->match_tag_not);
1283 snl_add_msg_attr_u8(nw, PF_RT_NATPASS, r->natpass);
1284 snl_add_msg_attr_u8(nw, PF_RT_KEEP_STATE, r->keep_state);
1285 snl_add_msg_attr_u8(nw, PF_RT_AF, r->af);
1286 snl_add_msg_attr_u8(nw, PF_RT_PROTO, r->proto);
1287 snl_add_msg_attr_u8(nw, PF_RT_TYPE, r->type);
1288 snl_add_msg_attr_u8(nw, PF_RT_CODE, r->code);
1289 snl_add_msg_attr_u8(nw, PF_RT_FLAGS, r->flags);
1290 snl_add_msg_attr_u8(nw, PF_RT_FLAGSET, r->flagset);
1291 snl_add_msg_attr_u8(nw, PF_RT_MIN_TTL, r->min_ttl);
1292 snl_add_msg_attr_u8(nw, PF_RT_ALLOW_OPTS, r->allow_opts);
1293 snl_add_msg_attr_u8(nw, PF_RT_RT, r->rt);
1294 snl_add_msg_attr_u8(nw, PF_RT_RETURN_TTL, r->return_ttl);
1295 snl_add_msg_attr_u8(nw, PF_RT_TOS, r->tos);
1296 snl_add_msg_attr_u8(nw, PF_RT_SET_TOS, r->set_tos);
1297
1298 snl_add_msg_attr_u8(nw, PF_RT_ANCHOR_RELATIVE, r->anchor_relative);
1299 snl_add_msg_attr_u8(nw, PF_RT_ANCHOR_WILDCARD, r->anchor_wildcard);
1300 snl_add_msg_attr_u8(nw, PF_RT_FLUSH, r->flush);
1301 snl_add_msg_attr_u8(nw, PF_RT_PRIO, r->prio);
1302 snl_add_msg_attr_u8(nw, PF_RT_SET_PRIO, r->set_prio[0]);
1303 snl_add_msg_attr_u8(nw, PF_RT_SET_PRIO_REPLY, r->set_prio[1]);
1304 snl_add_msg_attr_u8(nw, PF_RT_NAF, r->naf);
1305
1306 snl_add_msg_attr_ip6(nw, PF_RT_DIVERT_ADDRESS, &r->divert.addr.v6);
1307 snl_add_msg_attr_u16(nw, PF_RT_DIVERT_PORT, r->divert.port);
1308
1309 snl_end_attr_nested(nw, off);
1310 }
1311
1312 int
pfctl_add_rule(int dev __unused,const struct pfctl_rule * r,const char * anchor,const char * anchor_call,uint32_t ticket,uint32_t pool_ticket)1313 pfctl_add_rule(int dev __unused, const struct pfctl_rule *r, const char *anchor,
1314 const char *anchor_call, uint32_t ticket, uint32_t pool_ticket)
1315 {
1316 struct pfctl_handle *h;
1317 int ret;
1318
1319 h = pfctl_open(PF_DEVICE);
1320 if (h == NULL)
1321 return (ENODEV);
1322
1323 ret = pfctl_add_rule_h(h, r, anchor, anchor_call, ticket, pool_ticket);
1324
1325 pfctl_close(h);
1326
1327 return (ret);
1328 }
1329
1330 int
pfctl_add_rule_h(struct pfctl_handle * h,const struct pfctl_rule * r,const char * anchor,const char * anchor_call,uint32_t ticket,uint32_t pool_ticket)1331 pfctl_add_rule_h(struct pfctl_handle *h, const struct pfctl_rule *r,
1332 const char *anchor, const char *anchor_call, uint32_t ticket,
1333 uint32_t pool_ticket)
1334 {
1335 struct snl_writer nw;
1336 struct snl_errmsg_data e = {};
1337 struct nlmsghdr *hdr;
1338 uint32_t seq_id;
1339 int family_id;
1340
1341 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
1342 if (family_id == 0)
1343 return (ENOTSUP);
1344
1345 snl_init_writer(&h->ss, &nw);
1346 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_ADDRULE);
1347 hdr->nlmsg_flags |= NLM_F_DUMP;
1348 snl_add_msg_attr_u32(&nw, PF_ART_TICKET, ticket);
1349 snl_add_msg_attr_u32(&nw, PF_ART_POOL_TICKET, pool_ticket);
1350 snl_add_msg_attr_string(&nw, PF_ART_ANCHOR, anchor);
1351 snl_add_msg_attr_string(&nw, PF_ART_ANCHOR_CALL, anchor_call);
1352
1353 snl_add_msg_attr_pf_rule(&nw, PF_ART_RULE, r);
1354
1355 if ((hdr = snl_finalize_msg(&nw)) == NULL)
1356 return (ENXIO);
1357
1358 seq_id = hdr->nlmsg_seq;
1359
1360 if (! snl_send_message(&h->ss, hdr))
1361 return (ENXIO);
1362
1363 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
1364 }
1365
1366 return (e.error);
1367 }
1368
1369 #define _IN(_field) offsetof(struct genlmsghdr, _field)
1370 #define _OUT(_field) offsetof(struct pfctl_rules_info, _field)
1371 static struct snl_attr_parser ap_getrules[] = {
1372 { .type = PF_GR_NR, .off = _OUT(nr), .cb = snl_attr_get_uint32 },
1373 { .type = PF_GR_TICKET, .off = _OUT(ticket), .cb = snl_attr_get_uint32 },
1374 };
1375 #undef _IN
1376 #undef _OUT
1377 SNL_DECLARE_PARSER(getrules_parser, struct genlmsghdr, snl_f_p_empty, ap_getrules);
1378
1379 int
pfctl_get_rules_info_h(struct pfctl_handle * h,struct pfctl_rules_info * rules,uint32_t ruleset,const char * path)1380 pfctl_get_rules_info_h(struct pfctl_handle *h, struct pfctl_rules_info *rules, uint32_t ruleset,
1381 const char *path)
1382 {
1383 struct snl_errmsg_data e = {};
1384 struct nlmsghdr *hdr;
1385 struct snl_writer nw;
1386 uint32_t seq_id;
1387 int family_id;
1388
1389 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
1390 if (family_id == 0)
1391 return (ENOTSUP);
1392
1393 snl_init_writer(&h->ss, &nw);
1394 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_GETRULES);
1395 hdr->nlmsg_flags |= NLM_F_DUMP;
1396
1397 snl_add_msg_attr_string(&nw, PF_GR_ANCHOR, path);
1398 snl_add_msg_attr_u8(&nw, PF_GR_ACTION, ruleset);
1399
1400 hdr = snl_finalize_msg(&nw);
1401 if (hdr == NULL)
1402 return (ENOMEM);
1403
1404 seq_id = hdr->nlmsg_seq;
1405 if (! snl_send_message(&h->ss, hdr))
1406 return (ENXIO);
1407
1408 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
1409 if (! snl_parse_nlmsg(&h->ss, hdr, &getrules_parser, rules))
1410 continue;
1411 }
1412
1413 return (e.error);
1414 }
1415
1416 int
pfctl_get_rules_info(int dev __unused,struct pfctl_rules_info * rules,uint32_t ruleset,const char * path)1417 pfctl_get_rules_info(int dev __unused, struct pfctl_rules_info *rules, uint32_t ruleset,
1418 const char *path)
1419 {
1420 struct pfctl_handle *h;
1421 int error;
1422
1423 h = pfctl_open(PF_DEVICE);
1424 if (h == NULL)
1425 return (ENOTSUP);
1426 error = pfctl_get_rules_info_h(h, rules, ruleset, path);
1427 pfctl_close(h);
1428
1429 return (error);
1430 }
1431
1432 int
pfctl_get_rule_h(struct pfctl_handle * h,uint32_t nr,uint32_t ticket,const char * anchor,uint32_t ruleset,struct pfctl_rule * rule,char * anchor_call)1433 pfctl_get_rule_h(struct pfctl_handle *h, uint32_t nr, uint32_t ticket, const char *anchor,
1434 uint32_t ruleset, struct pfctl_rule *rule, char *anchor_call)
1435 {
1436 return (pfctl_get_clear_rule_h(h, nr, ticket, anchor, ruleset, rule,
1437 anchor_call, false));
1438 }
1439
1440 int
pfctl_get_rule(int dev,uint32_t nr,uint32_t ticket,const char * anchor,uint32_t ruleset,struct pfctl_rule * rule,char * anchor_call)1441 pfctl_get_rule(int dev, uint32_t nr, uint32_t ticket, const char *anchor,
1442 uint32_t ruleset, struct pfctl_rule *rule, char *anchor_call)
1443 {
1444 return (pfctl_get_clear_rule(dev, nr, ticket, anchor, ruleset, rule,
1445 anchor_call, false));
1446 }
1447
1448 #define _OUT(_field) offsetof(struct pf_addr_wrap, _field)
1449 static const struct snl_attr_parser ap_addr_wrap[] = {
1450 { .type = PF_AT_ADDR, .off = _OUT(v.a.addr), .cb = snl_attr_get_in6_addr },
1451 { .type = PF_AT_MASK, .off = _OUT(v.a.mask), .cb = snl_attr_get_in6_addr },
1452 { .type = PF_AT_IFNAME, .off = _OUT(v.ifname), .arg = (void *)IFNAMSIZ,.cb = snl_attr_copy_string },
1453 { .type = PF_AT_TABLENAME, .off = _OUT(v.tblname), .arg = (void *)PF_TABLE_NAME_SIZE, .cb = snl_attr_copy_string },
1454 { .type = PF_AT_TYPE, .off = _OUT(type), .cb = snl_attr_get_uint8 },
1455 { .type = PF_AT_IFLAGS, .off = _OUT(iflags), .cb = snl_attr_get_uint8 },
1456 { .type = PF_AT_TBLCNT, .off = _OUT(p.tblcnt), .cb = snl_attr_get_uint32 },
1457 { .type = PF_AT_DYNCNT, .off = _OUT(p.dyncnt), .cb = snl_attr_get_uint32 },
1458 };
1459 SNL_DECLARE_ATTR_PARSER(addr_wrap_parser, ap_addr_wrap);
1460 #undef _OUT
1461
1462 #define _OUT(_field) offsetof(struct pf_rule_addr, _field)
1463 static struct snl_attr_parser ap_rule_addr[] = {
1464 { .type = PF_RAT_ADDR, .off = _OUT(addr), .arg = &addr_wrap_parser, .cb = snl_attr_get_nested },
1465 { .type = PF_RAT_SRC_PORT, .off = _OUT(port[0]), .cb = snl_attr_get_uint16 },
1466 { .type = PF_RAT_DST_PORT, .off = _OUT(port[1]), .cb = snl_attr_get_uint16 },
1467 { .type = PF_RAT_NEG, .off = _OUT(neg), .cb = snl_attr_get_uint8 },
1468 { .type = PF_RAT_OP, .off = _OUT(port_op), .cb = snl_attr_get_uint8 },
1469 };
1470 #undef _OUT
1471 SNL_DECLARE_ATTR_PARSER(rule_addr_parser, ap_rule_addr);
1472
1473 struct snl_parsed_labels
1474 {
1475 char labels[PF_RULE_MAX_LABEL_COUNT][PF_RULE_LABEL_SIZE];
1476 uint32_t i;
1477 };
1478
1479 static bool
snl_attr_get_pf_rule_labels(struct snl_state * ss,struct nlattr * nla,const void * arg __unused,void * target)1480 snl_attr_get_pf_rule_labels(struct snl_state *ss, struct nlattr *nla,
1481 const void *arg __unused, void *target)
1482 {
1483 struct snl_parsed_labels *l = (struct snl_parsed_labels *)target;
1484 bool ret;
1485
1486 if (l->i >= PF_RULE_MAX_LABEL_COUNT)
1487 return (E2BIG);
1488
1489 ret = snl_attr_copy_string(ss, nla, (void *)PF_RULE_LABEL_SIZE,
1490 l->labels[l->i]);
1491 if (ret)
1492 l->i++;
1493
1494 return (ret);
1495 }
1496
1497 #define _OUT(_field) offsetof(struct nl_parsed_labels, _field)
1498 static const struct snl_attr_parser ap_labels[] = {
1499 { .type = PF_LT_LABEL, .off = 0, .cb = snl_attr_get_pf_rule_labels },
1500 };
1501 SNL_DECLARE_ATTR_PARSER(rule_labels_parser, ap_labels);
1502 #undef _OUT
1503
1504 static bool
snl_attr_get_nested_pf_rule_labels(struct snl_state * ss,struct nlattr * nla,const void * arg __unused,void * target)1505 snl_attr_get_nested_pf_rule_labels(struct snl_state *ss, struct nlattr *nla,
1506 const void *arg __unused, void *target)
1507 {
1508 struct snl_parsed_labels parsed_labels = { };
1509 bool error;
1510
1511 /* Assumes target points to the beginning of the structure */
1512 error = snl_parse_header(ss, NLA_DATA(nla), NLA_DATA_LEN(nla), &rule_labels_parser, &parsed_labels);
1513 if (! error)
1514 return (error);
1515
1516 memcpy(target, parsed_labels.labels, sizeof(parsed_labels.labels));
1517
1518 return (true);
1519 }
1520
1521 #define _OUT(_field) offsetof(struct pf_mape_portset, _field)
1522 static const struct snl_attr_parser ap_mape_portset[] = {
1523 { .type = PF_MET_OFFSET, .off = _OUT(offset), .cb = snl_attr_get_uint8 },
1524 { .type = PF_MET_PSID_LEN, .off = _OUT(psidlen), .cb = snl_attr_get_uint8 },
1525 {. type = PF_MET_PSID, .off = _OUT(psid), .cb = snl_attr_get_uint16 },
1526 };
1527 SNL_DECLARE_ATTR_PARSER(mape_portset_parser, ap_mape_portset);
1528 #undef _OUT
1529
1530 #define _OUT(_field) offsetof(struct pfctl_pool, _field)
1531 static const struct snl_attr_parser ap_pool[] = {
1532 { .type = PF_PT_KEY, .off = _OUT(key), .arg = (void *)sizeof(struct pf_poolhashkey), .cb = snl_attr_get_bytes },
1533 { .type = PF_PT_COUNTER, .off = _OUT(counter), .cb = snl_attr_get_in6_addr },
1534 { .type = PF_PT_TBLIDX, .off = _OUT(tblidx), .cb = snl_attr_get_uint32 },
1535 { .type = PF_PT_PROXY_SRC_PORT, .off = _OUT(proxy_port[0]), .cb = snl_attr_get_uint16 },
1536 { .type = PF_PT_PROXY_DST_PORT, .off = _OUT(proxy_port[1]), .cb = snl_attr_get_uint16 },
1537 { .type = PF_PT_OPTS, .off = _OUT(opts), .cb = snl_attr_get_uint8 },
1538 { .type = PF_PT_MAPE, .off = _OUT(mape), .arg = &mape_portset_parser, .cb = snl_attr_get_nested },
1539 };
1540 SNL_DECLARE_ATTR_PARSER(pool_parser, ap_pool);
1541 #undef _OUT
1542
1543 struct nl_parsed_timeouts
1544 {
1545 uint32_t timeouts[PFTM_MAX];
1546 uint32_t i;
1547 };
1548
1549 static bool
snl_attr_get_pf_timeout(struct snl_state * ss,struct nlattr * nla,const void * arg __unused,void * target)1550 snl_attr_get_pf_timeout(struct snl_state *ss, struct nlattr *nla,
1551 const void *arg __unused, void *target)
1552 {
1553 struct nl_parsed_timeouts *t = (struct nl_parsed_timeouts *)target;
1554 bool ret;
1555
1556 if (t->i >= PFTM_MAX)
1557 return (E2BIG);
1558
1559 ret = snl_attr_get_uint32(ss, nla, NULL, &t->timeouts[t->i]);
1560 if (ret)
1561 t->i++;
1562
1563 return (ret);
1564 }
1565
1566 #define _OUT(_field) offsetof(struct nl_parsed_timeout, _field)
1567 static const struct snl_attr_parser ap_timeouts[] = {
1568 { .type = PF_TT_TIMEOUT, .off = 0, .cb = snl_attr_get_pf_timeout },
1569 };
1570 SNL_DECLARE_ATTR_PARSER(timeout_parser, ap_timeouts);
1571 #undef _OUT
1572
1573 static bool
snl_attr_get_nested_timeouts(struct snl_state * ss,struct nlattr * nla,const void * arg __unused,void * target)1574 snl_attr_get_nested_timeouts(struct snl_state *ss, struct nlattr *nla,
1575 const void *arg __unused, void *target)
1576 {
1577 struct nl_parsed_timeouts parsed_timeouts = { };
1578 bool error;
1579
1580 /* Assumes target points to the beginning of the structure */
1581 error = snl_parse_header(ss, NLA_DATA(nla), NLA_DATA_LEN(nla), &timeout_parser, &parsed_timeouts);
1582 if (! error)
1583 return (error);
1584
1585 memcpy(target, parsed_timeouts.timeouts, sizeof(parsed_timeouts.timeouts));
1586
1587 return (true);
1588 }
1589
1590 #define _OUT(_field) offsetof(struct pf_rule_uid, _field)
1591 static const struct snl_attr_parser ap_rule_uid[] = {
1592 { .type = PF_RUT_UID_LOW, .off = _OUT(uid[0]), .cb = snl_attr_get_uint32 },
1593 { .type = PF_RUT_UID_HIGH, .off = _OUT(uid[1]), .cb = snl_attr_get_uint32 },
1594 { .type = PF_RUT_OP, .off = _OUT(op), .cb = snl_attr_get_uint8 },
1595 };
1596 SNL_DECLARE_ATTR_PARSER(rule_uid_parser, ap_rule_uid);
1597 #undef _OUT
1598
1599 #define _OUT(_field) offsetof(struct pfctl_threshold, _field)
1600 static const struct snl_attr_parser ap_pfctl_threshold[] = {
1601 { .type = PF_TH_LIMIT, .off = _OUT(limit), .cb = snl_attr_get_uint32 },
1602 { .type = PF_TH_SECONDS, .off = _OUT(seconds), .cb = snl_attr_get_uint32 },
1603 { .type = PF_TH_COUNT, .off = _OUT(count), .cb = snl_attr_get_uint32 },
1604 };
1605 SNL_DECLARE_ATTR_PARSER(pfctl_threshold_parser, ap_pfctl_threshold);
1606 #undef _OUT
1607
1608 struct pfctl_nl_get_rule {
1609 struct pfctl_rule r;
1610 char anchor_call[MAXPATHLEN];
1611 };
1612 #define _OUT(_field) offsetof(struct pfctl_nl_get_rule, _field)
1613 static struct snl_attr_parser ap_getrule[] = {
1614 { .type = PF_RT_SRC, .off = _OUT(r.src), .arg = &rule_addr_parser,.cb = snl_attr_get_nested },
1615 { .type = PF_RT_DST, .off = _OUT(r.dst), .arg = &rule_addr_parser,.cb = snl_attr_get_nested },
1616 { .type = PF_RT_RIDENTIFIER, .off = _OUT(r.ridentifier), .cb = snl_attr_get_uint32 },
1617 { .type = PF_RT_LABELS, .off = _OUT(r.label), .arg = &rule_labels_parser,.cb = snl_attr_get_nested_pf_rule_labels },
1618 { .type = PF_RT_IFNAME, .off = _OUT(r.ifname), .arg = (void *)IFNAMSIZ, .cb = snl_attr_copy_string },
1619 { .type = PF_RT_QNAME, .off = _OUT(r.qname), .arg = (void *)PF_QNAME_SIZE, .cb = snl_attr_copy_string },
1620 { .type = PF_RT_PQNAME, .off = _OUT(r.pqname), .arg = (void *)PF_QNAME_SIZE, .cb = snl_attr_copy_string },
1621 { .type = PF_RT_TAGNAME, .off = _OUT(r.tagname), .arg = (void *)PF_TAG_NAME_SIZE, .cb = snl_attr_copy_string },
1622 { .type = PF_RT_MATCH_TAGNAME, .off = _OUT(r.match_tagname), .arg = (void *)PF_TAG_NAME_SIZE, .cb = snl_attr_copy_string },
1623 { .type = PF_RT_OVERLOAD_TBLNAME, .off = _OUT(r.overload_tblname), .arg = (void *)PF_TABLE_NAME_SIZE, .cb = snl_attr_copy_string },
1624 { .type = PF_RT_RPOOL_RDR, .off = _OUT(r.rdr), .arg = &pool_parser, .cb = snl_attr_get_nested },
1625 { .type = PF_RT_OS_FINGERPRINT, .off = _OUT(r.os_fingerprint), .cb = snl_attr_get_uint32 },
1626 { .type = PF_RT_RTABLEID, .off = _OUT(r.rtableid), .cb = snl_attr_get_uint32 },
1627 { .type = PF_RT_TIMEOUT, .off = _OUT(r.timeout), .arg = &timeout_parser, .cb = snl_attr_get_nested_timeouts },
1628 { .type = PF_RT_MAX_STATES, .off = _OUT(r.max_states), .cb = snl_attr_get_uint32 },
1629 { .type = PF_RT_MAX_SRC_NODES, .off = _OUT(r.max_src_nodes), .cb = snl_attr_get_uint32 },
1630 { .type = PF_RT_MAX_SRC_STATES, .off = _OUT(r.max_src_states), .cb = snl_attr_get_uint32 },
1631 { .type = PF_RT_MAX_SRC_CONN_RATE_LIMIT, .off = _OUT(r.max_src_conn_rate.limit), .cb = snl_attr_get_uint32 },
1632 { .type = PF_RT_MAX_SRC_CONN_RATE_SECS, .off = _OUT(r.max_src_conn_rate.seconds), .cb = snl_attr_get_uint32 },
1633 { .type = PF_RT_DNPIPE, .off = _OUT(r.dnpipe), .cb = snl_attr_get_uint16 },
1634 { .type = PF_RT_DNRPIPE, .off = _OUT(r.dnrpipe), .cb = snl_attr_get_uint16 },
1635 { .type = PF_RT_DNFLAGS, .off = _OUT(r.free_flags), .cb = snl_attr_get_uint32 },
1636 { .type = PF_RT_NR, .off = _OUT(r.nr), .cb = snl_attr_get_uint32 },
1637 { .type = PF_RT_PROB, .off = _OUT(r.prob), .cb = snl_attr_get_uint32 },
1638 { .type = PF_RT_CUID, .off = _OUT(r.cuid), .cb = snl_attr_get_uint32 },
1639 {. type = PF_RT_CPID, .off = _OUT(r.cpid), .cb = snl_attr_get_uint32 },
1640 { .type = PF_RT_RETURN_ICMP, .off = _OUT(r.return_icmp), .cb = snl_attr_get_uint16 },
1641 { .type = PF_RT_RETURN_ICMP6, .off = _OUT(r.return_icmp6), .cb = snl_attr_get_uint16 },
1642 { .type = PF_RT_MAX_MSS, .off = _OUT(r.max_mss), .cb = snl_attr_get_uint16 },
1643 { .type = PF_RT_SCRUB_FLAGS, .off = _OUT(r.scrub_flags), .cb = snl_attr_get_uint16 },
1644 { .type = PF_RT_UID, .off = _OUT(r.uid), .arg = &rule_uid_parser, .cb = snl_attr_get_nested },
1645 { .type = PF_RT_GID, .off = _OUT(r.gid), .arg = &rule_uid_parser, .cb = snl_attr_get_nested },
1646 { .type = PF_RT_RULE_FLAG, .off = _OUT(r.rule_flag), .cb = snl_attr_get_uint32 },
1647 { .type = PF_RT_ACTION, .off = _OUT(r.action), .cb = snl_attr_get_uint8 },
1648 { .type = PF_RT_DIRECTION, .off = _OUT(r.direction), .cb = snl_attr_get_uint8 },
1649 { .type = PF_RT_LOG, .off = _OUT(r.log), .cb = snl_attr_get_uint8 },
1650 { .type = PF_RT_LOGIF, .off = _OUT(r.logif), .cb = snl_attr_get_uint8 },
1651 { .type = PF_RT_QUICK, .off = _OUT(r.quick), .cb = snl_attr_get_uint8 },
1652 { .type = PF_RT_IF_NOT, .off = _OUT(r.ifnot), .cb = snl_attr_get_uint8 },
1653 { .type = PF_RT_MATCH_TAG_NOT, .off = _OUT(r.match_tag_not), .cb = snl_attr_get_uint8 },
1654 { .type = PF_RT_NATPASS, .off = _OUT(r.natpass), .cb = snl_attr_get_uint8 },
1655 { .type = PF_RT_KEEP_STATE, .off = _OUT(r.keep_state), .cb = snl_attr_get_uint8 },
1656 { .type = PF_RT_AF, .off = _OUT(r.af), .cb = snl_attr_get_uint8 },
1657 { .type = PF_RT_PROTO, .off = _OUT(r.proto), .cb = snl_attr_get_uint8 },
1658 { .type = PF_RT_TYPE, .off = _OUT(r.type), .cb = snl_attr_get_uint8 },
1659 { .type = PF_RT_CODE, .off = _OUT(r.code), .cb = snl_attr_get_uint8 },
1660 { .type = PF_RT_FLAGS, .off = _OUT(r.flags), .cb = snl_attr_get_uint8 },
1661 { .type = PF_RT_FLAGSET, .off = _OUT(r.flagset), .cb = snl_attr_get_uint8 },
1662 { .type = PF_RT_MIN_TTL, .off = _OUT(r.min_ttl), .cb = snl_attr_get_uint8 },
1663 { .type = PF_RT_ALLOW_OPTS, .off = _OUT(r.allow_opts), .cb = snl_attr_get_uint8 },
1664 { .type = PF_RT_RT, .off = _OUT(r.rt), .cb = snl_attr_get_uint8 },
1665 { .type = PF_RT_RETURN_TTL, .off = _OUT(r.return_ttl), .cb = snl_attr_get_uint8 },
1666 { .type = PF_RT_TOS, .off = _OUT(r.tos), .cb = snl_attr_get_uint8 },
1667 { .type = PF_RT_SET_TOS, .off = _OUT(r.set_tos), .cb = snl_attr_get_uint8 },
1668 { .type = PF_RT_ANCHOR_RELATIVE, .off = _OUT(r.anchor_relative), .cb = snl_attr_get_uint8 },
1669 { .type = PF_RT_ANCHOR_WILDCARD, .off = _OUT(r.anchor_wildcard), .cb = snl_attr_get_uint8 },
1670 { .type = PF_RT_FLUSH, .off = _OUT(r.flush), .cb = snl_attr_get_uint8 },
1671 { .type = PF_RT_PRIO, .off = _OUT(r.prio), .cb = snl_attr_get_uint8 },
1672 { .type = PF_RT_SET_PRIO, .off = _OUT(r.set_prio[0]), .cb = snl_attr_get_uint8 },
1673 { .type = PF_RT_SET_PRIO_REPLY, .off = _OUT(r.set_prio[1]), .cb = snl_attr_get_uint8 },
1674 { .type = PF_RT_DIVERT_ADDRESS, .off = _OUT(r.divert.addr), .cb = snl_attr_get_in6_addr },
1675 { .type = PF_RT_DIVERT_PORT, .off = _OUT(r.divert.port), .cb = snl_attr_get_uint16 },
1676 { .type = PF_RT_PACKETS_IN, .off = _OUT(r.packets[0]), .cb = snl_attr_get_uint64 },
1677 { .type = PF_RT_PACKETS_OUT, .off = _OUT(r.packets[1]), .cb = snl_attr_get_uint64 },
1678 { .type = PF_RT_BYTES_IN, .off = _OUT(r.bytes[0]), .cb = snl_attr_get_uint64 },
1679 { .type = PF_RT_BYTES_OUT, .off = _OUT(r.bytes[1]), .cb = snl_attr_get_uint64 },
1680 { .type = PF_RT_EVALUATIONS, .off = _OUT(r.evaluations), .cb = snl_attr_get_uint64 },
1681 { .type = PF_RT_TIMESTAMP, .off = _OUT(r.last_active_timestamp), .cb = snl_attr_get_uint64 },
1682 { .type = PF_RT_STATES_CUR, .off = _OUT(r.states_cur), .cb = snl_attr_get_uint64 },
1683 { .type = PF_RT_STATES_TOTAL, .off = _OUT(r.states_tot), .cb = snl_attr_get_uint64 },
1684 { .type = PF_RT_SRC_NODES, .off = _OUT(r.src_nodes), .cb = snl_attr_get_uint64 },
1685 { .type = PF_RT_ANCHOR_CALL, .off = _OUT(anchor_call), .arg = (void*)MAXPATHLEN, .cb = snl_attr_copy_string },
1686 { .type = PF_RT_RCV_IFNAME, .off = _OUT(r.rcv_ifname), .arg = (void*)IFNAMSIZ, .cb = snl_attr_copy_string },
1687 { .type = PF_RT_MAX_SRC_CONN, .off = _OUT(r.max_src_conn), .cb = snl_attr_get_uint32 },
1688 { .type = PF_RT_RPOOL_NAT, .off = _OUT(r.nat), .arg = &pool_parser, .cb = snl_attr_get_nested },
1689 { .type = PF_RT_NAF, .off = _OUT(r.naf), .cb = snl_attr_get_uint8 },
1690 { .type = PF_RT_RPOOL_RT, .off = _OUT(r.route), .arg = &pool_parser, .cb = snl_attr_get_nested },
1691 { .type = PF_RT_RCV_IFNOT, .off = _OUT(r.rcvifnot),.cb = snl_attr_get_bool },
1692 { .type = PF_RT_SRC_NODES_LIMIT, .off = _OUT(r.src_nodes_type[PF_SN_LIMIT]), .cb = snl_attr_get_uint64 },
1693 { .type = PF_RT_SRC_NODES_NAT, .off = _OUT(r.src_nodes_type[PF_SN_NAT]), .cb = snl_attr_get_uint64 },
1694 { .type = PF_RT_SRC_NODES_ROUTE, .off = _OUT(r.src_nodes_type[PF_SN_ROUTE]), .cb = snl_attr_get_uint64 },
1695 { .type = PF_RT_PKTRATE, .off = _OUT(r.pktrate), .arg = &pfctl_threshold_parser, .cb = snl_attr_get_nested },
1696 { .type = PF_RT_MAX_PKT_SIZE, .off =_OUT(r.max_pkt_size), .cb = snl_attr_get_uint16 },
1697 };
1698 #undef _OUT
1699 SNL_DECLARE_PARSER(getrule_parser, struct genlmsghdr, snl_f_p_empty, ap_getrule);
1700
1701 int
pfctl_get_clear_rule_h(struct pfctl_handle * h,uint32_t nr,uint32_t ticket,const char * anchor,uint32_t ruleset,struct pfctl_rule * rule,char * anchor_call,bool clear)1702 pfctl_get_clear_rule_h(struct pfctl_handle *h, uint32_t nr, uint32_t ticket,
1703 const char *anchor, uint32_t ruleset, struct pfctl_rule *rule,
1704 char *anchor_call, bool clear)
1705 {
1706 struct pfctl_nl_get_rule attrs = {};
1707 struct snl_errmsg_data e = {};
1708 struct nlmsghdr *hdr;
1709 struct snl_writer nw;
1710 uint32_t seq_id;
1711 int family_id;
1712
1713 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
1714 if (family_id == 0)
1715 return (ENOTSUP);
1716
1717 snl_init_writer(&h->ss, &nw);
1718 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_GETRULE);
1719 hdr->nlmsg_flags |= NLM_F_DUMP;
1720
1721 snl_add_msg_attr_string(&nw, PF_GR_ANCHOR, anchor);
1722 snl_add_msg_attr_u8(&nw, PF_GR_ACTION, ruleset);
1723 snl_add_msg_attr_u32(&nw, PF_GR_NR, nr);
1724 snl_add_msg_attr_u32(&nw, PF_GR_TICKET, ticket);
1725 snl_add_msg_attr_u8(&nw, PF_GR_CLEAR, clear);
1726
1727 hdr = snl_finalize_msg(&nw);
1728 if (hdr == NULL)
1729 return (ENOMEM);
1730
1731 seq_id = hdr->nlmsg_seq;
1732 if (! snl_send_message(&h->ss, hdr))
1733 return (ENXIO);
1734
1735 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
1736 if (! snl_parse_nlmsg(&h->ss, hdr, &getrule_parser, &attrs))
1737 continue;
1738 }
1739
1740 memcpy(rule, &attrs.r, sizeof(attrs.r));
1741 strlcpy(anchor_call, attrs.anchor_call, MAXPATHLEN);
1742
1743 return (e.error);
1744 }
1745
1746 int
pfctl_get_clear_rule(int dev,uint32_t nr,uint32_t ticket,const char * anchor,uint32_t ruleset,struct pfctl_rule * rule,char * anchor_call,bool clear)1747 pfctl_get_clear_rule(int dev, uint32_t nr, uint32_t ticket,
1748 const char *anchor, uint32_t ruleset, struct pfctl_rule *rule,
1749 char *anchor_call, bool clear)
1750 {
1751 nvlist_t *nvl;
1752 int ret;
1753
1754 nvl = nvlist_create(0);
1755 if (nvl == 0)
1756 return (ENOMEM);
1757
1758 nvlist_add_number(nvl, "nr", nr);
1759 nvlist_add_number(nvl, "ticket", ticket);
1760 nvlist_add_string(nvl, "anchor", anchor);
1761 nvlist_add_number(nvl, "ruleset", ruleset);
1762
1763 if (clear)
1764 nvlist_add_bool(nvl, "clear_counter", true);
1765
1766 if ((ret = pfctl_do_ioctl(dev, DIOCGETRULENV, 8192, &nvl)) != 0)
1767 goto out;
1768
1769 pf_nvrule_to_rule(nvlist_get_nvlist(nvl, "rule"), rule);
1770
1771 if (anchor_call)
1772 strlcpy(anchor_call, nvlist_get_string(nvl, "anchor_call"),
1773 MAXPATHLEN);
1774
1775 out:
1776 nvlist_destroy(nvl);
1777 return (ret);
1778 }
1779
1780 int
pfctl_set_keepcounters(int dev,bool keep)1781 pfctl_set_keepcounters(int dev, bool keep)
1782 {
1783 struct pfioc_nv nv;
1784 nvlist_t *nvl;
1785 int ret;
1786
1787 nvl = nvlist_create(0);
1788
1789 nvlist_add_bool(nvl, "keep_counters", keep);
1790
1791 nv.data = nvlist_pack(nvl, &nv.len);
1792 nv.size = nv.len;
1793
1794 nvlist_destroy(nvl);
1795
1796 ret = ioctl(dev, DIOCKEEPCOUNTERS, &nv);
1797
1798 free(nv.data);
1799 return (ret);
1800 }
1801
1802 struct pfctl_creator {
1803 uint32_t id;
1804 };
1805 #define _IN(_field) offsetof(struct genlmsghdr, _field)
1806 #define _OUT(_field) offsetof(struct pfctl_creator, _field)
1807 static struct snl_attr_parser ap_creators[] = {
1808 { .type = PF_ST_CREATORID, .off = _OUT(id), .cb = snl_attr_get_uint32 },
1809 };
1810 #undef _IN
1811 #undef _OUT
1812 SNL_DECLARE_PARSER(creator_parser, struct genlmsghdr, snl_f_p_empty, ap_creators);
1813
1814 static int
pfctl_get_creators_nl(struct snl_state * ss,uint32_t * creators,size_t * len)1815 pfctl_get_creators_nl(struct snl_state *ss, uint32_t *creators, size_t *len)
1816 {
1817
1818 int family_id = snl_get_genl_family(ss, PFNL_FAMILY_NAME);
1819 size_t i = 0;
1820
1821 struct nlmsghdr *hdr;
1822 struct snl_writer nw;
1823
1824 if (family_id == 0)
1825 return (ENOTSUP);
1826
1827 snl_init_writer(ss, &nw);
1828 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_GETCREATORS);
1829 hdr->nlmsg_flags |= NLM_F_DUMP;
1830 hdr = snl_finalize_msg(&nw);
1831 if (hdr == NULL)
1832 return (ENOMEM);
1833 uint32_t seq_id = hdr->nlmsg_seq;
1834
1835 snl_send_message(ss, hdr);
1836
1837 struct snl_errmsg_data e = {};
1838 while ((hdr = snl_read_reply_multi(ss, seq_id, &e)) != NULL) {
1839 struct pfctl_creator c;
1840 bzero(&c, sizeof(c));
1841
1842 if (!snl_parse_nlmsg(ss, hdr, &creator_parser, &c))
1843 continue;
1844
1845 creators[i] = c.id;
1846 i++;
1847 if (i > *len)
1848 return (E2BIG);
1849 }
1850
1851 *len = i;
1852
1853 return (0);
1854 }
1855
1856 int
pfctl_get_creatorids(struct pfctl_handle * h,uint32_t * creators,size_t * len)1857 pfctl_get_creatorids(struct pfctl_handle *h, uint32_t *creators, size_t *len)
1858 {
1859 int error;
1860
1861 error = pfctl_get_creators_nl(&h->ss, creators, len);
1862
1863 return (error);
1864 }
1865
1866 static inline bool
snl_attr_get_pfaddr(struct snl_state * ss __unused,struct nlattr * nla,const void * arg __unused,void * target)1867 snl_attr_get_pfaddr(struct snl_state *ss __unused, struct nlattr *nla,
1868 const void *arg __unused, void *target)
1869 {
1870 memcpy(target, NLA_DATA(nla), NLA_DATA_LEN(nla));
1871 return (true);
1872 }
1873
1874 static inline bool
snl_attr_store_ifname(struct snl_state * ss __unused,struct nlattr * nla,const void * arg __unused,void * target)1875 snl_attr_store_ifname(struct snl_state *ss __unused, struct nlattr *nla,
1876 const void *arg __unused, void *target)
1877 {
1878 size_t maxlen = NLA_DATA_LEN(nla);
1879
1880 if (strnlen((char *)NLA_DATA(nla), maxlen) < maxlen) {
1881 strlcpy(target, (char *)NLA_DATA(nla), maxlen);
1882 return (true);
1883 }
1884 return (false);
1885 }
1886
1887 #define _OUT(_field) offsetof(struct pfctl_state_peer, _field)
1888 static const struct snl_attr_parser nla_p_speer[] = {
1889 { .type = PF_STP_SEQLO, .off = _OUT(seqlo), .cb = snl_attr_get_uint32 },
1890 { .type = PF_STP_SEQHI, .off = _OUT(seqhi), .cb = snl_attr_get_uint32 },
1891 { .type = PF_STP_SEQDIFF, .off = _OUT(seqdiff), .cb = snl_attr_get_uint32 },
1892 { .type = PF_STP_STATE, .off = _OUT(state), .cb = snl_attr_get_uint8 },
1893 { .type = PF_STP_WSCALE, .off = _OUT(wscale), .cb = snl_attr_get_uint8 },
1894 };
1895 SNL_DECLARE_ATTR_PARSER(speer_parser, nla_p_speer);
1896 #undef _OUT
1897
1898 #define _OUT(_field) offsetof(struct pfctl_state_key, _field)
1899 static const struct snl_attr_parser nla_p_skey[] = {
1900 { .type = PF_STK_ADDR0, .off = _OUT(addr[0]), .cb = snl_attr_get_pfaddr },
1901 { .type = PF_STK_ADDR1, .off = _OUT(addr[1]), .cb = snl_attr_get_pfaddr },
1902 { .type = PF_STK_PORT0, .off = _OUT(port[0]), .cb = snl_attr_get_uint16 },
1903 { .type = PF_STK_PORT1, .off = _OUT(port[1]), .cb = snl_attr_get_uint16 },
1904 { .type = PF_STK_AF, .off = _OUT(af), .cb = snl_attr_get_uint8 },
1905 { .type = PF_STK_PROTO, .off = _OUT(proto), .cb = snl_attr_get_uint16 },
1906 };
1907 SNL_DECLARE_ATTR_PARSER(skey_parser, nla_p_skey);
1908 #undef _OUT
1909
1910 #define _IN(_field) offsetof(struct genlmsghdr, _field)
1911 #define _OUT(_field) offsetof(struct pfctl_state, _field)
1912 static struct snl_attr_parser ap_state[] = {
1913 { .type = PF_ST_ID, .off = _OUT(id), .cb = snl_attr_get_uint64 },
1914 { .type = PF_ST_CREATORID, .off = _OUT(creatorid), .cb = snl_attr_get_uint32 },
1915 { .type = PF_ST_IFNAME, .off = _OUT(ifname), .cb = snl_attr_store_ifname },
1916 { .type = PF_ST_ORIG_IFNAME, .off = _OUT(orig_ifname), .cb = snl_attr_store_ifname },
1917 { .type = PF_ST_KEY_WIRE, .off = _OUT(key[0]), .arg = &skey_parser, .cb = snl_attr_get_nested },
1918 { .type = PF_ST_KEY_STACK, .off = _OUT(key[1]), .arg = &skey_parser, .cb = snl_attr_get_nested },
1919 { .type = PF_ST_PEER_SRC, .off = _OUT(src), .arg = &speer_parser, .cb = snl_attr_get_nested },
1920 { .type = PF_ST_PEER_DST, .off = _OUT(dst), .arg = &speer_parser, .cb = snl_attr_get_nested },
1921 { .type = PF_ST_RT_ADDR, .off = _OUT(rt_addr), .cb = snl_attr_get_pfaddr },
1922 { .type = PF_ST_RULE, .off = _OUT(rule), .cb = snl_attr_get_uint32 },
1923 { .type = PF_ST_ANCHOR, .off = _OUT(anchor), .cb = snl_attr_get_uint32 },
1924 { .type = PF_ST_NAT_RULE, .off = _OUT(nat_rule), .cb = snl_attr_get_uint32 },
1925 { .type = PF_ST_CREATION, .off = _OUT(creation), .cb = snl_attr_get_uint32 },
1926 { .type = PF_ST_EXPIRE, .off = _OUT(expire), .cb = snl_attr_get_uint32 },
1927 { .type = PF_ST_PACKETS0, .off = _OUT(packets[0]), .cb = snl_attr_get_uint64 },
1928 { .type = PF_ST_PACKETS1, .off = _OUT(packets[1]), .cb = snl_attr_get_uint64 },
1929 { .type = PF_ST_BYTES0, .off = _OUT(bytes[0]), .cb = snl_attr_get_uint64 },
1930 { .type = PF_ST_BYTES1, .off = _OUT(bytes[1]), .cb = snl_attr_get_uint64 },
1931 { .type = PF_ST_DIRECTION, .off = _OUT(direction), .cb = snl_attr_get_uint8 },
1932 { .type = PF_ST_LOG, .off = _OUT(log), .cb = snl_attr_get_uint8 },
1933 { .type = PF_ST_STATE_FLAGS, .off = _OUT(state_flags), .cb = snl_attr_get_uint16 },
1934 { .type = PF_ST_SYNC_FLAGS, .off = _OUT(sync_flags), .cb = snl_attr_get_uint8 },
1935 { .type = PF_ST_RTABLEID, .off = _OUT(rtableid), .cb = snl_attr_get_int32 },
1936 { .type = PF_ST_MIN_TTL, .off = _OUT(min_ttl), .cb = snl_attr_get_uint8 },
1937 { .type = PF_ST_MAX_MSS, .off = _OUT(max_mss), .cb = snl_attr_get_uint16 },
1938 { .type = PF_ST_DNPIPE, .off = _OUT(dnpipe), .cb = snl_attr_get_uint16 },
1939 { .type = PF_ST_DNRPIPE, .off = _OUT(dnrpipe), .cb = snl_attr_get_uint16 },
1940 { .type = PF_ST_RT, .off = _OUT(rt), .cb = snl_attr_get_uint8 },
1941 { .type = PF_ST_RT_IFNAME, .off = _OUT(rt_ifname), .cb = snl_attr_store_ifname },
1942 { .type = PF_ST_SRC_NODE_FLAGS, .off = _OUT(src_node_flags), .cb = snl_attr_get_uint8 },
1943 { .type = PF_ST_RT_AF, .off = _OUT(rt_af), .cb = snl_attr_get_uint8 },
1944 };
1945 #undef _IN
1946 #undef _OUT
1947 SNL_DECLARE_PARSER(state_parser, struct genlmsghdr, snl_f_p_empty, ap_state);
1948
1949 static const struct snl_hdr_parser *all_parsers[] = {
1950 &state_parser, &skey_parser, &speer_parser,
1951 &creator_parser, &getrules_parser
1952 };
1953
1954 static int
pfctl_get_states_nl(struct pfctl_state_filter * filter,struct snl_state * ss,pfctl_get_state_fn f,void * arg)1955 pfctl_get_states_nl(struct pfctl_state_filter *filter, struct snl_state *ss, pfctl_get_state_fn f, void *arg)
1956 {
1957 SNL_VERIFY_PARSERS(all_parsers);
1958 int family_id = snl_get_genl_family(ss, PFNL_FAMILY_NAME);
1959 int ret;
1960
1961 struct nlmsghdr *hdr;
1962 struct snl_writer nw;
1963
1964 if (family_id == 0)
1965 return (ENOTSUP);
1966
1967 snl_init_writer(ss, &nw);
1968 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_GETSTATES);
1969 hdr->nlmsg_flags |= NLM_F_DUMP;
1970 snl_add_msg_attr_string(&nw, PF_ST_IFNAME, filter->ifname);
1971 snl_add_msg_attr_u16(&nw, PF_ST_PROTO, filter->proto);
1972 snl_add_msg_attr_u8(&nw, PF_ST_AF, filter->af);
1973 snl_add_msg_attr_ip6(&nw, PF_ST_FILTER_ADDR, &filter->addr.v6);
1974 snl_add_msg_attr_ip6(&nw, PF_ST_FILTER_MASK, &filter->mask.v6);
1975
1976 hdr = snl_finalize_msg(&nw);
1977 if (hdr == NULL)
1978 return (ENOMEM);
1979
1980 uint32_t seq_id = hdr->nlmsg_seq;
1981
1982 snl_send_message(ss, hdr);
1983
1984 struct snl_errmsg_data e = {};
1985 while ((hdr = snl_read_reply_multi(ss, seq_id, &e)) != NULL) {
1986 struct pfctl_state s;
1987 bzero(&s, sizeof(s));
1988 if (!snl_parse_nlmsg(ss, hdr, &state_parser, &s))
1989 continue;
1990
1991 ret = f(&s, arg);
1992 if (ret != 0)
1993 return (ret);
1994 }
1995
1996 return (0);
1997 }
1998
1999 int
pfctl_get_states_iter(pfctl_get_state_fn f,void * arg)2000 pfctl_get_states_iter(pfctl_get_state_fn f, void *arg)
2001 {
2002 struct pfctl_state_filter filter = {};
2003 return (pfctl_get_filtered_states_iter(&filter, f, arg));
2004 }
2005
2006 int
pfctl_get_filtered_states_iter(struct pfctl_state_filter * filter,pfctl_get_state_fn f,void * arg)2007 pfctl_get_filtered_states_iter(struct pfctl_state_filter *filter, pfctl_get_state_fn f, void *arg)
2008 {
2009 struct snl_state ss = {};
2010 int error;
2011
2012 snl_init(&ss, NETLINK_GENERIC);
2013 error = pfctl_get_states_nl(filter, &ss, f, arg);
2014 snl_free(&ss);
2015
2016 return (error);
2017 }
2018
2019 static int
pfctl_append_states(struct pfctl_state * s,void * arg)2020 pfctl_append_states(struct pfctl_state *s, void *arg)
2021 {
2022 struct pfctl_state *new;
2023 struct pfctl_states *states = (struct pfctl_states *)arg;
2024
2025 new = malloc(sizeof(*s));
2026 if (new == NULL)
2027 return (ENOMEM);
2028
2029 memcpy(new, s, sizeof(*s));
2030
2031 TAILQ_INSERT_TAIL(&states->states, new, entry);
2032
2033 return (0);
2034 }
2035
2036 int
pfctl_get_states(int dev __unused,struct pfctl_states * states)2037 pfctl_get_states(int dev __unused, struct pfctl_states *states)
2038 {
2039 int ret;
2040
2041 bzero(states, sizeof(*states));
2042 TAILQ_INIT(&states->states);
2043
2044 ret = pfctl_get_states_iter(pfctl_append_states, states);
2045 if (ret != 0) {
2046 pfctl_free_states(states);
2047 return (ret);
2048 }
2049
2050 return (0);
2051 }
2052
2053 void
pfctl_free_states(struct pfctl_states * states)2054 pfctl_free_states(struct pfctl_states *states)
2055 {
2056 struct pfctl_state *s, *tmp;
2057
2058 TAILQ_FOREACH_SAFE(s, &states->states, entry, tmp) {
2059 free(s);
2060 }
2061
2062 bzero(states, sizeof(*states));
2063 }
2064
2065 struct pfctl_nl_clear_states {
2066 uint32_t killed;
2067 };
2068 #define _OUT(_field) offsetof(struct pfctl_nl_clear_states, _field)
2069 static struct snl_attr_parser ap_clear_states[] = {
2070 { .type = PF_CS_KILLED, .off = _OUT(killed), .cb = snl_attr_get_uint32 },
2071 };
2072 #undef _OUT
2073 SNL_DECLARE_PARSER(clear_states_parser, struct genlmsghdr, snl_f_p_empty, ap_clear_states);
2074
2075 static int
_pfctl_clear_states_h(struct pfctl_handle * h,const struct pfctl_kill * kill,unsigned int * killed,int cmd)2076 _pfctl_clear_states_h(struct pfctl_handle *h, const struct pfctl_kill *kill,
2077 unsigned int *killed, int cmd)
2078 {
2079 struct snl_writer nw;
2080 struct snl_errmsg_data e = {};
2081 struct pfctl_nl_clear_states attrs = {};
2082 struct nlmsghdr *hdr;
2083 uint32_t seq_id;
2084 int family_id;
2085
2086 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
2087 if (family_id == 0)
2088 return (ENOTSUP);
2089
2090 snl_init_writer(&h->ss, &nw);
2091 hdr = snl_create_genl_msg_request(&nw, family_id, cmd);
2092 hdr->nlmsg_flags |= NLM_F_DUMP;
2093
2094 snl_add_msg_attr_u64(&nw, PF_CS_CMP_ID, kill->cmp.id);
2095 snl_add_msg_attr_u32(&nw, PF_CS_CMP_CREATORID, htonl(kill->cmp.creatorid));
2096 snl_add_msg_attr_u8(&nw, PF_CS_CMP_DIR, kill->cmp.direction);
2097 snl_add_msg_attr_u8(&nw, PF_CS_AF, kill->af);
2098 snl_add_msg_attr_u8(&nw, PF_CS_PROTO, kill->proto);
2099 snl_add_msg_attr_rule_addr(&nw, PF_CS_SRC, &kill->src);
2100 snl_add_msg_attr_rule_addr(&nw, PF_CS_DST, &kill->dst);
2101 snl_add_msg_attr_rule_addr(&nw, PF_CS_RT_ADDR, &kill->rt_addr);
2102 snl_add_msg_attr_string(&nw, PF_CS_IFNAME, kill->ifname);
2103 snl_add_msg_attr_string(&nw, PF_CS_LABEL, kill->label);
2104 snl_add_msg_attr_bool(&nw, PF_CS_KILL_MATCH, kill->kill_match);
2105 snl_add_msg_attr_bool(&nw, PF_CS_NAT, kill->nat);
2106
2107 if ((hdr = snl_finalize_msg(&nw)) == NULL)
2108 return (ENXIO);
2109
2110 seq_id = hdr->nlmsg_seq;
2111
2112 if (! snl_send_message(&h->ss, hdr))
2113 return (ENXIO);
2114
2115 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
2116 if (! snl_parse_nlmsg(&h->ss, hdr, &clear_states_parser, &attrs))
2117 continue;
2118 }
2119
2120 if (killed)
2121 *killed = attrs.killed;
2122
2123 return (e.error);
2124 }
2125
2126 int
pfctl_clear_states_h(struct pfctl_handle * h,const struct pfctl_kill * kill,unsigned int * killed)2127 pfctl_clear_states_h(struct pfctl_handle *h, const struct pfctl_kill *kill,
2128 unsigned int *killed)
2129 {
2130 return(_pfctl_clear_states_h(h, kill, killed, PFNL_CMD_CLRSTATES));
2131 }
2132
2133 int
pfctl_kill_states_h(struct pfctl_handle * h,const struct pfctl_kill * kill,unsigned int * killed)2134 pfctl_kill_states_h(struct pfctl_handle *h, const struct pfctl_kill *kill,
2135 unsigned int *killed)
2136 {
2137 return(_pfctl_clear_states_h(h, kill, killed, PFNL_CMD_KILLSTATES));
2138 }
2139
2140 static int
_pfctl_clear_states(int dev __unused,const struct pfctl_kill * kill,unsigned int * killed,uint64_t cmd)2141 _pfctl_clear_states(int dev __unused, const struct pfctl_kill *kill,
2142 unsigned int *killed, uint64_t cmd)
2143 {
2144 struct pfctl_handle *h;
2145 int ret;
2146
2147 h = pfctl_open(PF_DEVICE);
2148 if (h == NULL)
2149 return (ENODEV);
2150
2151 ret = _pfctl_clear_states_h(h, kill, killed, cmd);
2152 pfctl_close(h);
2153
2154 return (ret);
2155 }
2156
2157 int
pfctl_clear_states(int dev __unused,const struct pfctl_kill * kill,unsigned int * killed)2158 pfctl_clear_states(int dev __unused, const struct pfctl_kill *kill,
2159 unsigned int *killed)
2160 {
2161 return (_pfctl_clear_states(dev, kill, killed, PFNL_CMD_CLRSTATES));
2162 }
2163
2164 int
pfctl_kill_states(int dev __unused,const struct pfctl_kill * kill,unsigned int * killed)2165 pfctl_kill_states(int dev __unused, const struct pfctl_kill *kill, unsigned int *killed)
2166 {
2167 return (_pfctl_clear_states(dev, kill, killed, PFNL_CMD_KILLSTATES));
2168 }
2169
2170 int
pfctl_clear_rules(int dev,const char * anchorname)2171 pfctl_clear_rules(int dev, const char *anchorname)
2172 {
2173 struct pfioc_trans trans;
2174 struct pfioc_trans_e transe[2];
2175 int ret;
2176
2177 bzero(&trans, sizeof(trans));
2178 bzero(&transe, sizeof(transe));
2179
2180 transe[0].rs_num = PF_RULESET_SCRUB;
2181 if (strlcpy(transe[0].anchor, anchorname, sizeof(transe[0].anchor))
2182 >= sizeof(transe[0].anchor))
2183 return (E2BIG);
2184
2185 transe[1].rs_num = PF_RULESET_FILTER;
2186 if (strlcpy(transe[1].anchor, anchorname, sizeof(transe[1].anchor))
2187 >= sizeof(transe[1].anchor))
2188 return (E2BIG);
2189
2190 trans.size = 2;
2191 trans.esize = sizeof(transe[0]);
2192 trans.array = transe;
2193
2194 ret = ioctl(dev, DIOCXBEGIN, &trans);
2195 if (ret != 0)
2196 return (errno);
2197 ret = ioctl(dev, DIOCXCOMMIT, &trans);
2198 if (ret != 0)
2199 return (errno);
2200
2201 return (0);
2202 }
2203
2204 int
pfctl_clear_nat(int dev,const char * anchorname)2205 pfctl_clear_nat(int dev, const char *anchorname)
2206 {
2207 struct pfioc_trans trans;
2208 struct pfioc_trans_e transe[3];
2209 int ret;
2210
2211 bzero(&trans, sizeof(trans));
2212 bzero(&transe, sizeof(transe));
2213
2214 transe[0].rs_num = PF_RULESET_NAT;
2215 if (strlcpy(transe[0].anchor, anchorname, sizeof(transe[0].anchor))
2216 >= sizeof(transe[0].anchor))
2217 return (E2BIG);
2218
2219 transe[1].rs_num = PF_RULESET_BINAT;
2220 if (strlcpy(transe[1].anchor, anchorname, sizeof(transe[1].anchor))
2221 >= sizeof(transe[0].anchor))
2222 return (E2BIG);
2223
2224 transe[2].rs_num = PF_RULESET_RDR;
2225 if (strlcpy(transe[2].anchor, anchorname, sizeof(transe[2].anchor))
2226 >= sizeof(transe[2].anchor))
2227 return (E2BIG);
2228
2229 trans.size = 3;
2230 trans.esize = sizeof(transe[0]);
2231 trans.array = transe;
2232
2233 ret = ioctl(dev, DIOCXBEGIN, &trans);
2234 if (ret != 0)
2235 return (errno);
2236 ret = ioctl(dev, DIOCXCOMMIT, &trans);
2237 if (ret != 0)
2238 return (errno);
2239
2240 return (0);
2241 }
2242
2243 int
pfctl_clear_eth_rules(int dev,const char * anchorname)2244 pfctl_clear_eth_rules(int dev, const char *anchorname)
2245 {
2246 struct pfioc_trans trans;
2247 struct pfioc_trans_e transe;
2248 int ret;
2249
2250 bzero(&trans, sizeof(trans));
2251 bzero(&transe, sizeof(transe));
2252
2253 transe.rs_num = PF_RULESET_ETH;
2254 if (strlcpy(transe.anchor, anchorname, sizeof(transe.anchor))
2255 >= sizeof(transe.anchor))
2256 return (E2BIG);
2257
2258 trans.size = 1;
2259 trans.esize = sizeof(transe);
2260 trans.array = &transe;
2261
2262 ret = ioctl(dev, DIOCXBEGIN, &trans);
2263 if (ret != 0)
2264 return (errno);
2265 ret = ioctl(dev, DIOCXCOMMIT, &trans);
2266 if (ret != 0)
2267 return (errno);
2268
2269 return (0);
2270 }
2271
2272 static int
_pfctl_get_limit(int dev,const int index,uint * limit)2273 _pfctl_get_limit(int dev, const int index, uint *limit)
2274 {
2275 struct pfioc_limit pl;
2276
2277 bzero(&pl, sizeof(pl));
2278 pl.index = index;
2279
2280 if (ioctl(dev, DIOCGETLIMIT, &pl) == -1)
2281 return (errno);
2282
2283 *limit = pl.limit;
2284
2285 return (0);
2286 }
2287
2288 int
pfctl_set_syncookies(int dev,const struct pfctl_syncookies * s)2289 pfctl_set_syncookies(int dev, const struct pfctl_syncookies *s)
2290 {
2291 struct pfioc_nv nv;
2292 nvlist_t *nvl;
2293 int ret;
2294 uint state_limit;
2295 uint64_t lim, hi, lo;
2296
2297 ret = _pfctl_get_limit(dev, PF_LIMIT_STATES, &state_limit);
2298 if (ret != 0)
2299 return (ret);
2300
2301 if (state_limit == 0)
2302 state_limit = INT_MAX;
2303
2304 lim = state_limit;
2305 hi = lim * s->highwater / 100;
2306 lo = lim * s->lowwater / 100;
2307
2308 if (lo == hi)
2309 hi++;
2310
2311 nvl = nvlist_create(0);
2312
2313 nvlist_add_bool(nvl, "enabled", s->mode != PFCTL_SYNCOOKIES_NEVER);
2314 nvlist_add_bool(nvl, "adaptive", s->mode == PFCTL_SYNCOOKIES_ADAPTIVE);
2315 nvlist_add_number(nvl, "highwater", hi);
2316 nvlist_add_number(nvl, "lowwater", lo);
2317
2318 nv.data = nvlist_pack(nvl, &nv.len);
2319 nv.size = nv.len;
2320 nvlist_destroy(nvl);
2321 nvl = NULL;
2322
2323 ret = ioctl(dev, DIOCSETSYNCOOKIES, &nv);
2324
2325 free(nv.data);
2326 if (ret != 0)
2327 return (errno);
2328
2329 return (0);
2330 }
2331
2332 int
pfctl_get_syncookies(int dev,struct pfctl_syncookies * s)2333 pfctl_get_syncookies(int dev, struct pfctl_syncookies *s)
2334 {
2335 nvlist_t *nvl;
2336 int ret;
2337 uint state_limit;
2338 bool enabled, adaptive;
2339
2340 ret = _pfctl_get_limit(dev, PF_LIMIT_STATES, &state_limit);
2341 if (ret != 0)
2342 return (ret);
2343
2344 if (state_limit == 0)
2345 state_limit = INT_MAX;
2346
2347 bzero(s, sizeof(*s));
2348
2349 nvl = nvlist_create(0);
2350
2351 if ((ret = pfctl_do_ioctl(dev, DIOCGETSYNCOOKIES, 256, &nvl)) != 0) {
2352 ret = errno;
2353 goto out;
2354 }
2355
2356 enabled = nvlist_get_bool(nvl, "enabled");
2357 adaptive = nvlist_get_bool(nvl, "adaptive");
2358
2359 if (enabled) {
2360 if (adaptive)
2361 s->mode = PFCTL_SYNCOOKIES_ADAPTIVE;
2362 else
2363 s->mode = PFCTL_SYNCOOKIES_ALWAYS;
2364 } else {
2365 s->mode = PFCTL_SYNCOOKIES_NEVER;
2366 }
2367
2368 s->highwater = nvlist_get_number(nvl, "highwater") * 100 / state_limit;
2369 s->lowwater = nvlist_get_number(nvl, "lowwater") * 100 / state_limit;
2370 s->halfopen_states = nvlist_get_number(nvl, "halfopen_states");
2371
2372 out:
2373 nvlist_destroy(nvl);
2374 return (ret);
2375 }
2376
2377 int
pfctl_table_add_addrs(int dev,struct pfr_table * tbl,struct pfr_addr * addr,int size,int * nadd,int flags)2378 pfctl_table_add_addrs(int dev, struct pfr_table *tbl, struct pfr_addr
2379 *addr, int size, int *nadd, int flags)
2380 {
2381 struct pfioc_table io;
2382
2383 if (tbl == NULL || size < 0 || (size && addr == NULL)) {
2384 return (EINVAL);
2385 }
2386 bzero(&io, sizeof io);
2387 io.pfrio_flags = flags;
2388 io.pfrio_table = *tbl;
2389 io.pfrio_buffer = addr;
2390 io.pfrio_esize = sizeof(*addr);
2391 io.pfrio_size = size;
2392
2393 if (ioctl(dev, DIOCRADDADDRS, &io))
2394 return (errno);
2395 if (nadd != NULL)
2396 *nadd = io.pfrio_nadd;
2397 return (0);
2398 }
2399
2400 static void
snl_add_msg_attr_table(struct snl_writer * nw,uint32_t type,const struct pfr_table * tbl)2401 snl_add_msg_attr_table(struct snl_writer *nw, uint32_t type,
2402 const struct pfr_table *tbl)
2403 {
2404 int off;
2405
2406 off = snl_add_msg_attr_nested(nw, type);
2407
2408 snl_add_msg_attr_string(nw, PF_T_ANCHOR, tbl->pfrt_anchor);
2409 snl_add_msg_attr_string(nw, PF_T_NAME, tbl->pfrt_name);
2410 snl_add_msg_attr_u32(nw, PF_T_TABLE_FLAGS, tbl->pfrt_flags);
2411
2412 snl_end_attr_nested(nw, off);
2413 }
2414
2415 static void
snl_add_msg_attr_pfr_addr(struct snl_writer * nw,uint32_t type,const struct pfr_addr * addr)2416 snl_add_msg_attr_pfr_addr(struct snl_writer *nw, uint32_t type,
2417 const struct pfr_addr *addr)
2418 {
2419 int off;
2420
2421 off = snl_add_msg_attr_nested(nw, type);
2422
2423 snl_add_msg_attr_u8(nw, PFR_A_AF, addr->pfra_af);
2424 snl_add_msg_attr_u8(nw, PFR_A_NET, addr->pfra_net);
2425 snl_add_msg_attr_bool(nw, PFR_A_NOT, addr->pfra_not);
2426 snl_add_msg_attr_ip6(nw, PFR_A_ADDR, &addr->pfra_ip6addr);
2427
2428 snl_end_attr_nested(nw, off);
2429 }
2430
2431 static struct snl_attr_parser ap_table_add_addr[] = {
2432 { .type = PF_TA_NBR_ADDED, .off = 0, .cb = snl_attr_get_uint32 },
2433 };
2434 SNL_DECLARE_PARSER(table_add_addr_parser, struct genlmsghdr, snl_f_p_empty, ap_table_add_addr);
2435
2436 static int
_pfctl_table_add_addrs_h(struct pfctl_handle * h,struct pfr_table * tbl,struct pfr_addr * addrs,int size,int * nadd,int flags)2437 _pfctl_table_add_addrs_h(struct pfctl_handle *h, struct pfr_table *tbl, struct pfr_addr
2438 *addrs, int size, int *nadd, int flags)
2439 {
2440 struct snl_writer nw;
2441 struct snl_errmsg_data e = {};
2442 struct nlmsghdr *hdr;
2443 uint32_t seq_id;
2444 uint32_t added;
2445 int family_id;
2446
2447 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
2448 if (family_id == 0)
2449 return (ENOTSUP);
2450
2451 snl_init_writer(&h->ss, &nw);
2452 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_TABLE_ADD_ADDR);
2453
2454 snl_add_msg_attr_table(&nw, PF_TA_TABLE, tbl);
2455 snl_add_msg_attr_u32(&nw, PF_TA_FLAGS, flags);
2456 for (int i = 0; i < size; i++)
2457 snl_add_msg_attr_pfr_addr(&nw, PF_TA_ADDR, &addrs[i]);
2458
2459 if ((hdr = snl_finalize_msg(&nw)) == NULL)
2460 return (ENXIO);
2461 seq_id = hdr->nlmsg_seq;
2462
2463 if (! snl_send_message(&h->ss, hdr))
2464 return (ENXIO);
2465
2466 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
2467 if (! snl_parse_nlmsg(&h->ss, hdr, &table_add_addr_parser, &added))
2468 continue;
2469 }
2470
2471 if (nadd)
2472 *nadd = added;
2473
2474 return (e.error);
2475 }
2476
2477 int
pfctl_table_add_addrs_h(struct pfctl_handle * h,struct pfr_table * tbl,struct pfr_addr * addr,int size,int * nadd,int flags)2478 pfctl_table_add_addrs_h(struct pfctl_handle *h, struct pfr_table *tbl, struct pfr_addr
2479 *addr, int size, int *nadd, int flags)
2480 {
2481 int ret;
2482 int off = 0;
2483 int partial_added;
2484 int chunk_size;
2485
2486 do {
2487 chunk_size = MIN(size - off, 256);
2488 ret = _pfctl_table_add_addrs_h(h, tbl, &addr[off], chunk_size, &partial_added, flags);
2489 if (ret != 0)
2490 break;
2491 if (nadd)
2492 *nadd += partial_added;
2493 off += chunk_size;
2494 } while (off < size);
2495
2496 return (ret);
2497 }
2498
2499 static struct snl_attr_parser ap_table_del_addr[] = {
2500 { .type = PF_TA_NBR_DELETED, .off = 0, .cb = snl_attr_get_uint32 },
2501 };
2502 SNL_DECLARE_PARSER(table_del_addr_parser, struct genlmsghdr, snl_f_p_empty, ap_table_del_addr);
2503 static int
_pfctl_table_del_addrs_h(struct pfctl_handle * h,struct pfr_table * tbl,struct pfr_addr * addrs,int size,int * ndel,int flags)2504 _pfctl_table_del_addrs_h(struct pfctl_handle *h, struct pfr_table *tbl, struct pfr_addr
2505 *addrs, int size, int *ndel, int flags)
2506 {
2507 struct snl_writer nw;
2508 struct snl_errmsg_data e = {};
2509 struct nlmsghdr *hdr;
2510 uint32_t seq_id;
2511 uint32_t deleted;
2512 int family_id;
2513
2514 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
2515 if (family_id == 0)
2516 return (ENOTSUP);
2517
2518 snl_init_writer(&h->ss, &nw);
2519 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_TABLE_DEL_ADDR);
2520
2521 snl_add_msg_attr_table(&nw, PF_TA_TABLE, tbl);
2522 snl_add_msg_attr_u32(&nw, PF_TA_FLAGS, flags);
2523 for (int i = 0; i < size; i++)
2524 snl_add_msg_attr_pfr_addr(&nw, PF_TA_ADDR, &addrs[i]);
2525
2526 if ((hdr = snl_finalize_msg(&nw)) == NULL)
2527 return (ENXIO);
2528 seq_id = hdr->nlmsg_seq;
2529
2530 if (! snl_send_message(&h->ss, hdr))
2531 return (ENXIO);
2532
2533 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
2534 if (! snl_parse_nlmsg(&h->ss, hdr, &table_del_addr_parser, &deleted))
2535 continue;
2536 }
2537
2538 if (ndel)
2539 *ndel = deleted;
2540
2541 return (e.error);
2542 }
2543
2544 int
pfctl_table_del_addrs(int dev,struct pfr_table * tbl,struct pfr_addr * addr,int size,int * ndel,int flags)2545 pfctl_table_del_addrs(int dev, struct pfr_table *tbl, struct pfr_addr
2546 *addr, int size, int *ndel, int flags)
2547 {
2548 struct pfioc_table io;
2549
2550 if (tbl == NULL || size < 0 || (size && addr == NULL)) {
2551 return (EINVAL);
2552 }
2553 bzero(&io, sizeof io);
2554 io.pfrio_flags = flags;
2555 io.pfrio_table = *tbl;
2556 io.pfrio_buffer = addr;
2557 io.pfrio_esize = sizeof(*addr);
2558 io.pfrio_size = size;
2559
2560 if (ioctl(dev, DIOCRDELADDRS, &io))
2561 return (errno);
2562 if (ndel != NULL)
2563 *ndel = io.pfrio_ndel;
2564 return (0);
2565 }
2566
2567 int
pfctl_table_del_addrs_h(struct pfctl_handle * h,struct pfr_table * tbl,struct pfr_addr * addr,int size,int * ndel,int flags)2568 pfctl_table_del_addrs_h(struct pfctl_handle *h, struct pfr_table *tbl, struct pfr_addr
2569 *addr, int size, int *ndel, int flags)
2570 {
2571 int ret;
2572 int off = 0;
2573 int partial_deleted;
2574 int chunk_size;
2575
2576 do {
2577 chunk_size = MIN(size - off, 256);
2578 ret = _pfctl_table_del_addrs_h(h, tbl, &addr[off], chunk_size,
2579 &partial_deleted, flags);
2580 if (ret != 0)
2581 break;
2582 if (ndel)
2583 *ndel += partial_deleted;
2584 off += chunk_size;
2585 } while (off < size);
2586
2587 return (ret);
2588 }
2589
2590 int
pfctl_table_set_addrs(int dev,struct pfr_table * tbl,struct pfr_addr * addr,int size,int * size2,int * nadd,int * ndel,int * nchange,int flags)2591 pfctl_table_set_addrs(int dev, struct pfr_table *tbl, struct pfr_addr
2592 *addr, int size, int *size2, int *nadd, int *ndel, int *nchange, int flags)
2593 {
2594 struct pfioc_table io;
2595
2596 if (tbl == NULL || size < 0 || (size && addr == NULL)) {
2597 return (EINVAL);
2598 }
2599 bzero(&io, sizeof io);
2600 io.pfrio_flags = flags;
2601 io.pfrio_table = *tbl;
2602 io.pfrio_buffer = addr;
2603 io.pfrio_esize = sizeof(*addr);
2604 io.pfrio_size = size;
2605 io.pfrio_size2 = (size2 != NULL) ? *size2 : 0;
2606 if (ioctl(dev, DIOCRSETADDRS, &io))
2607 return (errno);
2608 if (nadd != NULL)
2609 *nadd = io.pfrio_nadd;
2610 if (ndel != NULL)
2611 *ndel = io.pfrio_ndel;
2612 if (nchange != NULL)
2613 *nchange = io.pfrio_nchange;
2614 if (size2 != NULL)
2615 *size2 = io.pfrio_size2;
2616 return (0);
2617 }
2618
pfctl_table_get_addrs(int dev,struct pfr_table * tbl,struct pfr_addr * addr,int * size,int flags)2619 int pfctl_table_get_addrs(int dev, struct pfr_table *tbl, struct pfr_addr *addr,
2620 int *size, int flags)
2621 {
2622 struct pfioc_table io;
2623
2624 if (tbl == NULL || size == NULL || *size < 0 ||
2625 (*size && addr == NULL)) {
2626 return (EINVAL);
2627 }
2628 bzero(&io, sizeof io);
2629 io.pfrio_flags = flags;
2630 io.pfrio_table = *tbl;
2631 io.pfrio_buffer = addr;
2632 io.pfrio_esize = sizeof(*addr);
2633 io.pfrio_size = *size;
2634 if (ioctl(dev, DIOCRGETADDRS, &io))
2635 return (errno);
2636 *size = io.pfrio_size;
2637 return (0);
2638 }
2639
2640 int
pfctl_set_statusif(struct pfctl_handle * h,const char * ifname)2641 pfctl_set_statusif(struct pfctl_handle *h, const char *ifname)
2642 {
2643 struct snl_writer nw;
2644 struct snl_errmsg_data e = {};
2645 struct nlmsghdr *hdr;
2646 uint32_t seq_id;
2647 int family_id;
2648
2649 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
2650 if (family_id == 0)
2651 return (ENOTSUP);
2652
2653 snl_init_writer(&h->ss, &nw);
2654 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_SET_STATUSIF);
2655
2656 snl_add_msg_attr_string(&nw, PF_SS_IFNAME, ifname);
2657
2658 if ((hdr = snl_finalize_msg(&nw)) == NULL)
2659 return (ENXIO);
2660
2661 seq_id = hdr->nlmsg_seq;
2662
2663 if (! snl_send_message(&h->ss, hdr))
2664 return (ENXIO);
2665
2666 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
2667 }
2668
2669 return (e.error);
2670 }
2671
2672 #define _IN(_field) offsetof(struct genlmsghdr, _field)
2673 #define _OUT(_field) offsetof(struct pfctl_natlook, _field)
2674 static struct snl_attr_parser ap_natlook[] = {
2675 { .type = PF_NL_SRC_ADDR, .off = _OUT(saddr), .cb = snl_attr_get_in6_addr },
2676 { .type = PF_NL_DST_ADDR, .off = _OUT(daddr), .cb = snl_attr_get_in6_addr },
2677 { .type = PF_NL_SRC_PORT, .off = _OUT(sport), .cb = snl_attr_get_uint16 },
2678 { .type = PF_NL_DST_PORT, .off = _OUT(dport), .cb = snl_attr_get_uint16 },
2679 };
2680 #undef _IN
2681 #undef _OUT
2682 SNL_DECLARE_PARSER(natlook_parser, struct genlmsghdr, snl_f_p_empty, ap_natlook);
2683
2684 int
pfctl_natlook(struct pfctl_handle * h,const struct pfctl_natlook_key * k,struct pfctl_natlook * r)2685 pfctl_natlook(struct pfctl_handle *h, const struct pfctl_natlook_key *k,
2686 struct pfctl_natlook *r)
2687 {
2688 struct snl_writer nw;
2689 struct snl_errmsg_data e = {};
2690 struct nlmsghdr *hdr;
2691 uint32_t seq_id;
2692 int family_id;
2693
2694 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
2695 if (family_id == 0)
2696 return (ENOTSUP);
2697
2698 snl_init_writer(&h->ss, &nw);
2699 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_NATLOOK);
2700 hdr->nlmsg_flags |= NLM_F_DUMP;
2701
2702 snl_add_msg_attr_u8(&nw, PF_NL_AF, k->af);
2703 snl_add_msg_attr_u8(&nw, PF_NL_DIRECTION, k->direction);
2704 snl_add_msg_attr_u8(&nw, PF_NL_PROTO, k->proto);
2705 snl_add_msg_attr_ip6(&nw, PF_NL_SRC_ADDR, &k->saddr.v6);
2706 snl_add_msg_attr_ip6(&nw, PF_NL_DST_ADDR, &k->daddr.v6);
2707 snl_add_msg_attr_u16(&nw, PF_NL_SRC_PORT, k->sport);
2708 snl_add_msg_attr_u16(&nw, PF_NL_DST_PORT, k->dport);
2709
2710 if ((hdr = snl_finalize_msg(&nw)) == NULL)
2711 return (ENXIO);
2712
2713 seq_id = hdr->nlmsg_seq;
2714
2715 if (! snl_send_message(&h->ss, hdr))
2716 return (ENXIO);
2717
2718 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
2719 if (! snl_parse_nlmsg(&h->ss, hdr, &natlook_parser, r))
2720 continue;
2721 }
2722
2723 return (e.error);
2724 }
2725
2726 int
pfctl_set_debug(struct pfctl_handle * h,uint32_t level)2727 pfctl_set_debug(struct pfctl_handle *h, uint32_t level)
2728 {
2729 struct snl_writer nw;
2730 struct snl_errmsg_data e = {};
2731 struct nlmsghdr *hdr;
2732 uint32_t seq_id;
2733 int family_id;
2734
2735 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
2736 if (family_id == 0)
2737 return (ENOTSUP);
2738
2739 snl_init_writer(&h->ss, &nw);
2740 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_SET_DEBUG);
2741
2742 snl_add_msg_attr_u32(&nw, PF_SD_LEVEL, level);
2743
2744 if ((hdr = snl_finalize_msg(&nw)) == NULL)
2745 return (ENXIO);
2746
2747 seq_id = hdr->nlmsg_seq;
2748
2749 if (! snl_send_message(&h->ss, hdr))
2750 return (ENXIO);
2751
2752 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
2753 }
2754
2755 return (e.error);
2756 }
2757
2758 int
pfctl_set_timeout(struct pfctl_handle * h,uint32_t timeout,uint32_t seconds)2759 pfctl_set_timeout(struct pfctl_handle *h, uint32_t timeout, uint32_t seconds)
2760 {
2761 struct snl_writer nw;
2762 struct snl_errmsg_data e = {};
2763 struct nlmsghdr *hdr;
2764 uint32_t seq_id;
2765 int family_id;
2766
2767 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
2768 if (family_id == 0)
2769 return (ENOTSUP);
2770
2771 snl_init_writer(&h->ss, &nw);
2772 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_SET_TIMEOUT);
2773
2774 snl_add_msg_attr_u32(&nw, PF_TO_TIMEOUT, timeout);
2775 snl_add_msg_attr_u32(&nw, PF_TO_SECONDS, seconds);
2776
2777 if ((hdr = snl_finalize_msg(&nw)) == NULL)
2778 return (ENXIO);
2779
2780 seq_id = hdr->nlmsg_seq;
2781
2782 if (! snl_send_message(&h->ss, hdr))
2783 return (ENXIO);
2784
2785 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
2786 }
2787
2788 return (e.error);
2789 }
2790
2791 struct pfctl_nl_timeout {
2792 uint32_t seconds;
2793 };
2794 #define _OUT(_field) offsetof(struct pfctl_nl_timeout, _field)
2795 static struct snl_attr_parser ap_get_timeout[] = {
2796 { .type = PF_TO_SECONDS, .off = _OUT(seconds), .cb = snl_attr_get_uint32 },
2797 };
2798 #undef _OUT
2799 SNL_DECLARE_PARSER(get_timeout_parser, struct genlmsghdr, snl_f_p_empty, ap_get_timeout);
2800
2801 int
pfctl_get_timeout(struct pfctl_handle * h,uint32_t timeout,uint32_t * seconds)2802 pfctl_get_timeout(struct pfctl_handle *h, uint32_t timeout, uint32_t *seconds)
2803 {
2804 struct snl_writer nw;
2805 struct pfctl_nl_timeout to = {};
2806 struct snl_errmsg_data e = {};
2807 struct nlmsghdr *hdr;
2808 uint32_t seq_id;
2809 int family_id;
2810
2811 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
2812 if (family_id == 0)
2813 return (ENOTSUP);
2814
2815 snl_init_writer(&h->ss, &nw);
2816 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_GET_TIMEOUT);
2817 hdr->nlmsg_flags |= NLM_F_DUMP;
2818
2819 snl_add_msg_attr_u32(&nw, PF_TO_TIMEOUT, timeout);
2820
2821 if ((hdr = snl_finalize_msg(&nw)) == NULL)
2822 return (ENXIO);
2823
2824 seq_id = hdr->nlmsg_seq;
2825
2826 if (! snl_send_message(&h->ss, hdr))
2827 return (ENXIO);
2828
2829 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
2830 if (! snl_parse_nlmsg(&h->ss, hdr, &get_timeout_parser, &to))
2831 continue;
2832 }
2833
2834 if (seconds != NULL)
2835 *seconds = to.seconds;
2836
2837 return (e.error);
2838 }
2839
2840 int
pfctl_set_limit(struct pfctl_handle * h,const int index,const uint limit)2841 pfctl_set_limit(struct pfctl_handle *h, const int index, const uint limit)
2842 {
2843 struct snl_writer nw;
2844 struct snl_errmsg_data e = {};
2845 struct nlmsghdr *hdr;
2846 uint32_t seq_id;
2847 int family_id;
2848
2849 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
2850 if (family_id == 0)
2851 return (ENOTSUP);
2852
2853 snl_init_writer(&h->ss, &nw);
2854 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_SET_LIMIT);
2855
2856 snl_add_msg_attr_u32(&nw, PF_LI_INDEX, index);
2857 snl_add_msg_attr_u32(&nw, PF_LI_LIMIT, limit);
2858
2859 if ((hdr = snl_finalize_msg(&nw)) == NULL)
2860 return (ENXIO);
2861
2862 seq_id = hdr->nlmsg_seq;
2863
2864 if (! snl_send_message(&h->ss, hdr))
2865 return (ENXIO);
2866
2867 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
2868 }
2869
2870 return (e.error);
2871 }
2872
2873 struct pfctl_nl_limit {
2874 unsigned int limit;
2875 };
2876 #define _OUT(_field) offsetof(struct pfctl_nl_limit, _field)
2877 static struct snl_attr_parser ap_get_limit[] = {
2878 { .type = PF_LI_LIMIT, .off = _OUT(limit), .cb = snl_attr_get_uint32 },
2879 };
2880 #undef _OUT
2881 SNL_DECLARE_PARSER(get_limit_parser, struct genlmsghdr, snl_f_p_empty, ap_get_limit);
2882
2883 int
pfctl_get_limit(struct pfctl_handle * h,const int index,uint * limit)2884 pfctl_get_limit(struct pfctl_handle *h, const int index, uint *limit)
2885 {
2886 struct snl_writer nw;
2887 struct pfctl_nl_limit li = {};
2888 struct snl_errmsg_data e = {};
2889 struct nlmsghdr *hdr;
2890 uint32_t seq_id;
2891 int family_id;
2892
2893 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
2894 if (family_id == 0)
2895 return (ENOTSUP);
2896
2897 snl_init_writer(&h->ss, &nw);
2898 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_GET_LIMIT);
2899 hdr->nlmsg_flags |= NLM_F_DUMP;
2900
2901 snl_add_msg_attr_u32(&nw, PF_LI_INDEX, index);
2902
2903 if ((hdr = snl_finalize_msg(&nw)) == NULL)
2904 return (ENXIO);
2905
2906 seq_id = hdr->nlmsg_seq;
2907
2908 if (! snl_send_message(&h->ss, hdr))
2909 return (ENXIO);
2910
2911 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
2912 if (! snl_parse_nlmsg(&h->ss, hdr, &get_limit_parser, &li))
2913 continue;
2914 }
2915
2916 if (limit != NULL)
2917 *limit = li.limit;
2918
2919 return (e.error);
2920 }
2921
2922 struct pfctl_nl_begin_addrs {
2923 uint32_t ticket;
2924 };
2925 #define _OUT(_field) offsetof(struct pfctl_nl_begin_addrs, _field)
2926 static struct snl_attr_parser ap_begin_addrs[] = {
2927 { .type = PF_BA_TICKET, .off = _OUT(ticket), .cb = snl_attr_get_uint32 },
2928 };
2929 #undef _OUT
2930 SNL_DECLARE_PARSER(begin_addrs_parser, struct genlmsghdr, snl_f_p_empty, ap_begin_addrs);
2931
2932 int
pfctl_begin_addrs(struct pfctl_handle * h,uint32_t * ticket)2933 pfctl_begin_addrs(struct pfctl_handle *h, uint32_t *ticket)
2934 {
2935 struct snl_writer nw;
2936 struct pfctl_nl_begin_addrs attrs = {};
2937 struct snl_errmsg_data e = {};
2938 struct nlmsghdr *hdr;
2939 uint32_t seq_id;
2940 int family_id;
2941
2942 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
2943 if (family_id == 0)
2944 return (ENOTSUP);
2945
2946 snl_init_writer(&h->ss, &nw);
2947 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_BEGIN_ADDRS);
2948 hdr->nlmsg_flags |= NLM_F_DUMP;
2949
2950 if ((hdr = snl_finalize_msg(&nw)) == NULL)
2951 return (ENXIO);
2952
2953 seq_id = hdr->nlmsg_seq;
2954
2955 if (! snl_send_message(&h->ss, hdr))
2956 return (ENXIO);
2957
2958 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
2959 if (! snl_parse_nlmsg(&h->ss, hdr, &begin_addrs_parser, &attrs))
2960 continue;
2961 }
2962
2963 if (ticket != NULL)
2964 *ticket = attrs.ticket;
2965
2966 return (e.error);
2967 }
2968
2969 int
pfctl_add_addr(struct pfctl_handle * h,const struct pfioc_pooladdr * pa,int which)2970 pfctl_add_addr(struct pfctl_handle *h, const struct pfioc_pooladdr *pa, int which)
2971 {
2972 struct snl_writer nw;
2973 struct snl_errmsg_data e = {};
2974 struct nlmsghdr *hdr;
2975 uint32_t seq_id;
2976 int family_id;
2977
2978 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
2979 if (family_id == 0)
2980 return (ENOTSUP);
2981
2982 snl_init_writer(&h->ss, &nw);
2983 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_ADD_ADDR);
2984
2985 snl_add_msg_attr_u32(&nw, PF_AA_ACTION, pa->action);
2986 snl_add_msg_attr_u32(&nw, PF_AA_TICKET, pa->ticket);
2987 snl_add_msg_attr_u32(&nw, PF_AA_NR, pa->nr);
2988 snl_add_msg_attr_u32(&nw, PF_AA_R_NUM, pa->r_num);
2989 snl_add_msg_attr_u8(&nw, PF_AA_R_ACTION, pa->r_action);
2990 snl_add_msg_attr_u8(&nw, PF_AA_R_LAST, pa->r_last);
2991 snl_add_msg_attr_u8(&nw, PF_AA_AF, pa->af);
2992 snl_add_msg_attr_string(&nw, PF_AA_ANCHOR, pa->anchor);
2993 snl_add_msg_attr_pool_addr(&nw, PF_AA_ADDR, &pa->addr);
2994 snl_add_msg_attr_u32(&nw, PF_AA_WHICH, which);
2995
2996 if ((hdr = snl_finalize_msg(&nw)) == NULL)
2997 return (ENXIO);
2998
2999 seq_id = hdr->nlmsg_seq;
3000
3001 if (! snl_send_message(&h->ss, hdr))
3002 return (ENXIO);
3003
3004 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
3005 }
3006
3007 return (e.error);
3008 }
3009
3010 static const struct snl_attr_parser ap_get_addrs[] = {
3011 { .type = PF_AA_NR, .off = 0, .cb = snl_attr_get_uint32 },
3012 };
3013 SNL_DECLARE_PARSER(get_addrs_parser, struct genlmsghdr, snl_f_p_empty, ap_get_addrs);
3014
3015 int
pfctl_get_addrs(struct pfctl_handle * h,uint32_t ticket,uint32_t r_num,uint8_t r_action,const char * anchor,uint32_t * nr,int which)3016 pfctl_get_addrs(struct pfctl_handle *h, uint32_t ticket, uint32_t r_num,
3017 uint8_t r_action, const char *anchor, uint32_t *nr, int which)
3018 {
3019 struct snl_writer nw;
3020 struct snl_errmsg_data e = {};
3021 struct nlmsghdr *hdr;
3022 uint32_t seq_id;
3023 int family_id;
3024
3025 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
3026 if (family_id == 0)
3027 return (ENOTSUP);
3028
3029 snl_init_writer(&h->ss, &nw);
3030 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_GET_ADDRS);
3031
3032 snl_add_msg_attr_u32(&nw, PF_AA_TICKET, ticket);
3033 snl_add_msg_attr_u32(&nw, PF_AA_R_NUM, r_num);
3034 snl_add_msg_attr_u8(&nw, PF_AA_R_ACTION, r_action);
3035 snl_add_msg_attr_string(&nw, PF_AA_ANCHOR, anchor);
3036 snl_add_msg_attr_u32(&nw, PF_AA_WHICH, which);
3037
3038 if ((hdr = snl_finalize_msg(&nw)) == NULL)
3039 return (ENXIO);
3040
3041 seq_id = hdr->nlmsg_seq;
3042
3043 if (! snl_send_message(&h->ss, hdr))
3044 return (ENXIO);
3045
3046 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
3047 if (! snl_parse_nlmsg(&h->ss, hdr, &get_addrs_parser, nr))
3048 continue;
3049 }
3050
3051 return (e.error);
3052 }
3053
3054 #define _OUT(_field) offsetof(struct pf_pooladdr, _field)
3055 static const struct snl_attr_parser ap_pool_addr[] = {
3056 { .type = PF_PA_ADDR, .off = _OUT(addr), .arg = &addr_wrap_parser, .cb = snl_attr_get_nested },
3057 { .type = PF_PA_IFNAME, .off = _OUT(ifname), .arg_u32 = IFNAMSIZ, .cb = snl_attr_copy_string },
3058 };
3059 SNL_DECLARE_ATTR_PARSER(pool_addr_parser, ap_pool_addr);
3060 #undef _OUT
3061
3062 #define _OUT(_field) offsetof(struct pfioc_pooladdr, _field)
3063 static const struct snl_attr_parser ap_get_addr[] = {
3064 { .type = PF_AA_ACTION, .off = _OUT(action), .cb = snl_attr_get_uint32 },
3065 { .type = PF_AA_TICKET, .off = _OUT(ticket), .cb = snl_attr_get_uint32 },
3066 { .type = PF_AA_NR, .off = _OUT(nr), .cb = snl_attr_get_uint32 },
3067 { .type = PF_AA_R_NUM, .off = _OUT(r_num), .cb = snl_attr_get_uint32 },
3068 { .type = PF_AA_R_ACTION, .off = _OUT(r_action), .cb = snl_attr_get_uint8 },
3069 { .type = PF_AA_R_LAST, .off = _OUT(r_last), .cb = snl_attr_get_uint8 },
3070 { .type = PF_AA_AF, .off = _OUT(af), .cb = snl_attr_get_uint8 },
3071 { .type = PF_AA_ANCHOR, .off = _OUT(anchor), .arg_u32 = MAXPATHLEN, .cb = snl_attr_copy_string },
3072 { .type = PF_AA_ADDR, .off = _OUT(addr), .arg = &pool_addr_parser, .cb = snl_attr_get_nested },
3073 };
3074 SNL_DECLARE_PARSER(get_addr_parser, struct genlmsghdr, snl_f_p_empty, ap_get_addr);
3075 #undef _OUT
3076
3077 int
pfctl_get_addr(struct pfctl_handle * h,uint32_t ticket,uint32_t r_num,uint8_t r_action,const char * anchor,uint32_t nr,struct pfioc_pooladdr * pa,int which)3078 pfctl_get_addr(struct pfctl_handle *h, uint32_t ticket, uint32_t r_num,
3079 uint8_t r_action, const char *anchor, uint32_t nr, struct pfioc_pooladdr *pa,
3080 int which)
3081 {
3082 struct snl_writer nw;
3083 struct snl_errmsg_data e = {};
3084 struct nlmsghdr *hdr;
3085 uint32_t seq_id;
3086 int family_id;
3087
3088 family_id =snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
3089 if (family_id == 0)
3090 return (ENOTSUP);
3091
3092 snl_init_writer(&h->ss, &nw);
3093 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_GET_ADDR);
3094
3095 snl_add_msg_attr_u32(&nw, PF_AA_TICKET, ticket);
3096 snl_add_msg_attr_u32(&nw, PF_AA_R_NUM, r_num);
3097 snl_add_msg_attr_u8(&nw, PF_AA_R_ACTION, r_action);
3098 snl_add_msg_attr_string(&nw, PF_AA_ANCHOR, anchor);
3099 snl_add_msg_attr_u32(&nw, PF_AA_NR, nr);
3100 snl_add_msg_attr_u32(&nw, PF_AA_WHICH, which);
3101
3102 if ((hdr = snl_finalize_msg(&nw)) == NULL)
3103 return (ENXIO);
3104
3105 seq_id = hdr->nlmsg_seq;
3106
3107 if (! snl_send_message(&h->ss, hdr))
3108 return (ENXIO);
3109
3110 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
3111 if (! snl_parse_nlmsg(&h->ss, hdr, &get_addr_parser, pa))
3112 continue;
3113 }
3114
3115 return (e.error);
3116 }
3117
3118 #define _OUT(_field) offsetof(struct pfioc_ruleset, _field)
3119 static const struct snl_attr_parser ap_ruleset[] = {
3120 { .type = PF_RS_NR, .off = _OUT(nr), .cb = snl_attr_get_uint32 },
3121 { .type = PF_RS_NAME, .off = _OUT(name), .arg = (void *)PF_ANCHOR_NAME_SIZE, .cb = snl_attr_copy_string },
3122 };
3123 SNL_DECLARE_PARSER(ruleset_parser, struct genlmsghdr, snl_f_p_empty, ap_ruleset);
3124 #undef _OUT
3125
3126 int
pfctl_get_rulesets(struct pfctl_handle * h,const char * path,uint32_t * nr)3127 pfctl_get_rulesets(struct pfctl_handle *h, const char *path, uint32_t *nr)
3128 {
3129 struct snl_writer nw;
3130 struct snl_errmsg_data e = {};
3131 struct nlmsghdr *hdr;
3132 struct pfioc_ruleset rs = {};
3133 uint32_t seq_id;
3134 int family_id;
3135
3136 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
3137 if (family_id == 0)
3138 return (ENOTSUP);
3139
3140 snl_init_writer(&h->ss, &nw);
3141 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_GET_RULESETS);
3142
3143 snl_add_msg_attr_string(&nw, PF_RS_PATH, path);
3144
3145 if ((hdr = snl_finalize_msg(&nw)) == NULL)
3146 return (ENXIO);
3147
3148 seq_id = hdr->nlmsg_seq;
3149
3150 if (! snl_send_message(&h->ss, hdr))
3151 return (ENXIO);
3152
3153 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
3154 if (! snl_parse_nlmsg(&h->ss, hdr, &ruleset_parser, &rs))
3155 continue;
3156 }
3157
3158 *nr = rs.nr;
3159
3160 return (e.error);
3161 }
3162
3163 int
pfctl_get_ruleset(struct pfctl_handle * h,const char * path,uint32_t nr,struct pfioc_ruleset * rs)3164 pfctl_get_ruleset(struct pfctl_handle *h, const char *path, uint32_t nr, struct pfioc_ruleset *rs)
3165 {
3166 struct snl_writer nw;
3167 struct snl_errmsg_data e = {};
3168 struct nlmsghdr *hdr;
3169 uint32_t seq_id;
3170 int family_id;
3171
3172 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
3173 if (family_id == 0)
3174 return (ENOTSUP);
3175
3176 snl_init_writer(&h->ss, &nw);
3177 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_GET_RULESET);
3178
3179 snl_add_msg_attr_string(&nw, PF_RS_PATH, path);
3180 snl_add_msg_attr_u32(&nw, PF_RS_NR, nr);
3181
3182 if ((hdr = snl_finalize_msg(&nw)) == NULL)
3183 return (ENXIO);
3184
3185 seq_id = hdr->nlmsg_seq;
3186
3187 if (! snl_send_message(&h->ss, hdr))
3188 return (ENXIO);
3189
3190 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
3191 if (! snl_parse_nlmsg(&h->ss, hdr, &ruleset_parser, rs))
3192 continue;
3193 }
3194
3195 return (e.error);
3196 }
3197
3198 #define _OUT(_field) offsetof(struct pfctl_src_node, _field)
3199 static struct snl_attr_parser ap_srcnode[] = {
3200 { .type = PF_SN_ADDR, .off = _OUT(addr), .cb = snl_attr_get_in6_addr },
3201 { .type = PF_SN_RADDR, .off = _OUT(raddr), .cb = snl_attr_get_in6_addr },
3202 { .type = PF_SN_RULE_NR, .off = _OUT(rule), .cb = snl_attr_get_uint32 },
3203 { .type = PF_SN_BYTES_IN, .off = _OUT(bytes[0]), .cb = snl_attr_get_uint64 },
3204 { .type = PF_SN_BYTES_OUT, .off = _OUT(bytes[1]), .cb = snl_attr_get_uint64 },
3205 { .type = PF_SN_PACKETS_IN, .off = _OUT(packets[0]), .cb = snl_attr_get_uint64 },
3206 { .type = PF_SN_PACKETS_OUT, .off = _OUT(packets[1]), .cb = snl_attr_get_uint64 },
3207 { .type = PF_SN_STATES, .off = _OUT(states), .cb = snl_attr_get_uint32 },
3208 { .type = PF_SN_CONNECTIONS, .off = _OUT(conn), .cb = snl_attr_get_uint32 },
3209 { .type = PF_SN_AF, .off = _OUT(af), .cb = snl_attr_get_uint8 },
3210 { .type = PF_SN_RULE_TYPE, .off = _OUT(ruletype), .cb = snl_attr_get_uint8 },
3211 { .type = PF_SN_CREATION, .off = _OUT(creation), .cb = snl_attr_get_uint64 },
3212 { .type = PF_SN_EXPIRE, .off = _OUT(expire), .cb = snl_attr_get_uint64 },
3213 { .type = PF_SN_CONNECTION_RATE, .off = _OUT(conn_rate), .arg = &pfctl_threshold_parser, .cb = snl_attr_get_nested },
3214 { .type = PF_SN_RAF, .off = _OUT(raf), .cb = snl_attr_get_uint8 },
3215 { .type = PF_SN_NODE_TYPE, .off = _OUT(type), .cb = snl_attr_get_uint8 },
3216 };
3217 #undef _OUT
3218 SNL_DECLARE_PARSER(srcnode_parser, struct genlmsghdr, snl_f_p_empty, ap_srcnode);
3219
3220 int
pfctl_get_srcnodes(struct pfctl_handle * h,pfctl_get_srcnode_fn fn,void * arg)3221 pfctl_get_srcnodes(struct pfctl_handle *h, pfctl_get_srcnode_fn fn, void *arg)
3222 {
3223 struct snl_writer nw;
3224 struct pfctl_src_node sn;
3225 struct snl_errmsg_data e = {};
3226 struct nlmsghdr *hdr;
3227 uint32_t seq_id;
3228 int family_id;
3229 int ret;
3230
3231 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
3232 if (family_id == 0)
3233 return (ENOTSUP);
3234
3235 snl_init_writer(&h->ss, &nw);
3236 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_GET_SRCNODES);
3237
3238 if ((hdr = snl_finalize_msg(&nw)) == NULL)
3239 return (ENXIO);
3240
3241 seq_id = hdr->nlmsg_seq;
3242
3243 if (!snl_send_message(&h->ss, hdr))
3244 return (ENXIO);
3245
3246 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
3247 bzero(&sn, sizeof(sn));
3248 if (!snl_parse_nlmsg(&h->ss, hdr, &srcnode_parser, &sn))
3249 continue;
3250
3251 ret = fn(&sn, arg);
3252 if (ret != 0)
3253 return (ret);
3254 }
3255
3256 return (e.error);
3257 }
3258
3259 static struct snl_attr_parser ap_ndel[] = {
3260 { .type = PF_T_NBR_DELETED, .off = 0, .cb = snl_attr_get_uint32 },
3261 };
3262 SNL_DECLARE_PARSER(ndel_parser, struct genlmsghdr, snl_f_p_empty, ap_ndel);
3263
3264 int
pfctl_clear_tables(struct pfctl_handle * h,struct pfr_table * filter,int * ndel,int flags)3265 pfctl_clear_tables(struct pfctl_handle *h, struct pfr_table *filter,
3266 int *ndel, int flags)
3267 {
3268 struct snl_writer nw;
3269 struct snl_errmsg_data e = {};
3270 struct nlmsghdr *hdr;
3271 uint32_t seq_id;
3272 int family_id;
3273
3274 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
3275 if (family_id == 0)
3276 return (ENOTSUP);
3277
3278 snl_init_writer(&h->ss, &nw);
3279 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_CLEAR_TABLES);
3280
3281 snl_add_msg_attr_string(&nw, PF_T_ANCHOR, filter->pfrt_anchor);
3282 snl_add_msg_attr_string(&nw, PF_T_NAME, filter->pfrt_name);
3283 snl_add_msg_attr_u32(&nw, PF_T_TABLE_FLAGS, filter->pfrt_flags);
3284 snl_add_msg_attr_u32(&nw, PF_T_FLAGS, flags);
3285
3286 if ((hdr = snl_finalize_msg(&nw)) == NULL)
3287 return (ENXIO);
3288
3289 seq_id = hdr->nlmsg_seq;
3290
3291 if (!snl_send_message(&h->ss, hdr))
3292 return (ENXIO);
3293
3294 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
3295 if (!snl_parse_nlmsg(&h->ss, hdr, &ndel_parser, ndel))
3296 continue;
3297 }
3298
3299 return (e.error);
3300 }
3301
3302 static struct snl_attr_parser ap_nadd[] = {
3303 { .type = PF_T_NBR_ADDED, .off = 0, .cb = snl_attr_get_uint32 },
3304 };
3305 SNL_DECLARE_PARSER(nadd_parser, struct genlmsghdr, snl_f_p_empty, ap_nadd);
3306 int
pfctl_add_table(struct pfctl_handle * h,struct pfr_table * table,int * nadd,int flags)3307 pfctl_add_table(struct pfctl_handle *h, struct pfr_table *table,
3308 int *nadd, int flags)
3309 {
3310 struct snl_writer nw;
3311 struct snl_errmsg_data e = {};
3312 struct nlmsghdr *hdr;
3313 uint32_t seq_id;
3314 int family_id;
3315
3316 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
3317 if (family_id == 0)
3318 return (ENOTSUP);
3319
3320 snl_init_writer(&h->ss, &nw);
3321 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_ADD_TABLE);
3322
3323 snl_add_msg_attr_string(&nw, PF_T_ANCHOR, table->pfrt_anchor);
3324 snl_add_msg_attr_string(&nw, PF_T_NAME, table->pfrt_name);
3325 snl_add_msg_attr_u32(&nw, PF_T_TABLE_FLAGS, table->pfrt_flags);
3326 snl_add_msg_attr_u32(&nw, PF_T_FLAGS, flags);
3327
3328 if ((hdr = snl_finalize_msg(&nw)) == NULL)
3329 return (ENXIO);
3330
3331 seq_id = hdr->nlmsg_seq;
3332
3333 if (!snl_send_message(&h->ss, hdr))
3334 return (ENXIO);
3335
3336 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
3337 if (!snl_parse_nlmsg(&h->ss, hdr, &nadd_parser, nadd))
3338 continue;
3339 }
3340
3341 return (e.error);
3342 }
3343
3344 int
pfctl_del_table(struct pfctl_handle * h,struct pfr_table * table,int * ndel,int flags)3345 pfctl_del_table(struct pfctl_handle *h, struct pfr_table *table,
3346 int *ndel, int flags)
3347 {
3348 struct snl_writer nw;
3349 struct snl_errmsg_data e = {};
3350 struct nlmsghdr *hdr;
3351 uint32_t seq_id;
3352 int family_id;
3353
3354 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
3355 if (family_id == 0)
3356 return (ENOTSUP);
3357
3358 snl_init_writer(&h->ss, &nw);
3359 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_DEL_TABLE);
3360
3361 snl_add_msg_attr_string(&nw, PF_T_ANCHOR, table->pfrt_anchor);
3362 snl_add_msg_attr_string(&nw, PF_T_NAME, table->pfrt_name);
3363 snl_add_msg_attr_u32(&nw, PF_T_TABLE_FLAGS, table->pfrt_flags);
3364 snl_add_msg_attr_u32(&nw, PF_T_FLAGS, flags);
3365
3366 if ((hdr = snl_finalize_msg(&nw)) == NULL)
3367 return (ENXIO);
3368
3369 seq_id = hdr->nlmsg_seq;
3370
3371 if (!snl_send_message(&h->ss, hdr))
3372 return (ENXIO);
3373
3374 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
3375 if (!snl_parse_nlmsg(&h->ss, hdr, &ndel_parser, ndel))
3376 continue;
3377 }
3378
3379 return (e.error);
3380 }
3381
3382 static bool
snl_attr_get_uint64_into_int_array(struct snl_state * ss,struct nlattr * nla,const void * arg,void * target)3383 snl_attr_get_uint64_into_int_array(struct snl_state *ss, struct nlattr *nla,
3384 const void *arg, void *target)
3385 {
3386 uint64_t *u64target;
3387 struct snl_uint64_array a = {
3388 .count = 0,
3389 .max = (size_t)arg,
3390 };
3391 bool error;
3392
3393 u64target = malloc(a.max * sizeof(uint64_t));
3394 a.array = u64target;
3395
3396 error = snl_parse_header(ss, NLA_DATA(nla), NLA_DATA_LEN(nla), &array_parser, &a);
3397 if (! error)
3398 return (error);
3399
3400 for (size_t i = 0; i < a.count; i++)
3401 ((int *)target)[i] = (int)u64target[i];
3402
3403 free(u64target);
3404
3405 return (true);
3406 }
3407
3408 #define _OUT(_field) offsetof(struct pfr_table, _field)
3409 static const struct snl_attr_parser ap_table[] = {
3410 { .type = PF_T_ANCHOR, .off = _OUT(pfrt_anchor), .arg = (void *)MAXPATHLEN, .cb = snl_attr_copy_string },
3411 { .type = PF_T_NAME, .off = _OUT(pfrt_name), .arg = (void *)PF_TABLE_NAME_SIZE, .cb =snl_attr_copy_string },
3412 { .type = PF_T_TABLE_FLAGS, .off = _OUT(pfrt_flags), .cb = snl_attr_get_uint32 },
3413 };
3414 #undef _OUT
3415 SNL_DECLARE_ATTR_PARSER(table_parser, ap_table);
3416 #define _OUT(_field) offsetof(struct pfr_tstats, _field)
3417 static struct snl_attr_parser ap_tstats[] = {
3418 { .type = PF_TS_TABLE, .off = _OUT(pfrts_t), .arg = &table_parser, .cb = snl_attr_get_nested },
3419 { .type = PF_TS_PACKETS, .off = _OUT(pfrts_packets), .arg = (void *)(PFR_DIR_MAX * PFR_OP_TABLE_MAX), .cb = snl_attr_get_uint64_array},
3420 { .type = PF_TS_BYTES, .off = _OUT(pfrts_bytes), .arg = (void *)(PFR_DIR_MAX * PFR_OP_TABLE_MAX), .cb = snl_attr_get_uint64_array },
3421 { .type = PF_TS_MATCH, .off = _OUT(pfrts_match), .cb = snl_attr_get_uint64 },
3422 {. type = PF_TS_NOMATCH, .off = _OUT(pfrts_nomatch), .cb = snl_attr_get_uint64 },
3423 { .type = PF_TS_TZERO, .off = _OUT(pfrts_tzero), .cb = snl_attr_get_uint64 },
3424 { .type = PF_TS_REFCNT, .off = _OUT(pfrts_cnt), . arg = (void *)PFR_REFCNT_MAX, .cb = snl_attr_get_uint64_into_int_array },
3425 };
3426 #undef _OUT
3427 SNL_DECLARE_PARSER(tstats_parser, struct genlmsghdr, snl_f_p_empty, ap_tstats);
3428
3429 int
pfctl_get_tstats(struct pfctl_handle * h,const struct pfr_table * filter,pfctl_get_tstats_fn fn,void * arg)3430 pfctl_get_tstats(struct pfctl_handle *h, const struct pfr_table *filter,
3431 pfctl_get_tstats_fn fn, void *arg)
3432 {
3433 struct snl_writer nw;
3434 struct snl_errmsg_data e = {};
3435 struct nlmsghdr *hdr;
3436 uint32_t seq_id;
3437 int family_id;
3438 int ret;
3439
3440 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
3441 if (family_id == 0)
3442 return (ENOTSUP);
3443
3444 snl_init_writer(&h->ss, &nw);
3445 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_GET_TSTATS);
3446
3447 snl_add_msg_attr_string(&nw, PF_T_ANCHOR, filter->pfrt_anchor);
3448 snl_add_msg_attr_string(&nw, PF_T_NAME, filter->pfrt_name);
3449 snl_add_msg_attr_u32(&nw, PF_T_TABLE_FLAGS, filter->pfrt_flags);
3450
3451 if ((hdr = snl_finalize_msg(&nw)) == NULL)
3452 return (ENXIO);
3453
3454 seq_id = hdr->nlmsg_seq;
3455
3456 if (!snl_send_message(&h->ss, hdr))
3457 return (ENXIO);
3458
3459 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
3460 struct pfr_tstats tstats = {};
3461
3462 if (!snl_parse_nlmsg(&h->ss, hdr, &tstats_parser, &tstats))
3463 continue;
3464
3465 ret = fn(&tstats, arg);
3466 if (ret != 0)
3467 break;
3468 }
3469
3470 return (e.error);
3471 }
3472
3473 static struct snl_attr_parser ap_tstats_clr[] = {
3474 { .type = PF_TS_NZERO, .off = 0, .cb = snl_attr_get_uint64 },
3475 };
3476 SNL_DECLARE_PARSER(tstats_clr_parser, struct genlmsghdr, snl_f_p_empty, ap_tstats_clr);
3477
3478 int
pfctl_clear_tstats(struct pfctl_handle * h,const struct pfr_table * filter,int * nzero,int flags)3479 pfctl_clear_tstats(struct pfctl_handle *h, const struct pfr_table *filter,
3480 int *nzero, int flags)
3481 {
3482 struct snl_writer nw;
3483 struct snl_errmsg_data e = {};
3484 struct nlmsghdr *hdr;
3485 uint64_t zero;
3486 uint32_t seq_id;
3487 int family_id;
3488
3489 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
3490 if (family_id == 0)
3491 return (ENOTSUP);
3492
3493 snl_init_writer(&h->ss, &nw);
3494 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_CLR_TSTATS);
3495
3496 snl_add_msg_attr_string(&nw, PF_T_ANCHOR, filter->pfrt_anchor);
3497 snl_add_msg_attr_string(&nw, PF_T_NAME, filter->pfrt_name);
3498 snl_add_msg_attr_u32(&nw, PF_T_TABLE_FLAGS, filter->pfrt_flags);
3499 snl_add_msg_attr_u32(&nw, PF_T_FLAGS, flags);
3500
3501 if ((hdr = snl_finalize_msg(&nw)) == NULL)
3502 return (ENXIO);
3503
3504 seq_id = hdr->nlmsg_seq;
3505
3506 if (!snl_send_message(&h->ss, hdr))
3507 return (ENXIO);
3508
3509 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
3510 if (!snl_parse_nlmsg(&h->ss, hdr, &tstats_clr_parser, &zero))
3511 continue;
3512 if (nzero)
3513 *nzero = (uint32_t)zero;
3514 }
3515
3516 return (e.error);
3517 }
3518
3519 static struct snl_attr_parser ap_clr_addrs[] = {
3520 { .type = PF_T_NBR_DELETED, .off = 0, .cb = snl_attr_get_uint64 },
3521 };
3522 SNL_DECLARE_PARSER(clr_addrs_parser, struct genlmsghdr, snl_f_p_empty, ap_clr_addrs);
3523
3524 int
pfctl_clear_addrs(struct pfctl_handle * h,const struct pfr_table * filter,int * ndel,int flags)3525 pfctl_clear_addrs(struct pfctl_handle *h, const struct pfr_table *filter,
3526 int *ndel, int flags)
3527 {
3528 struct snl_writer nw;
3529 struct snl_errmsg_data e = {};
3530 struct nlmsghdr *hdr;
3531 uint64_t del;
3532 uint32_t seq_id;
3533 int family_id;
3534
3535 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
3536 if (family_id == 0)
3537 return (ENOTSUP);
3538
3539 snl_init_writer(&h->ss, &nw);
3540 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_CLR_ADDRS);
3541
3542 snl_add_msg_attr_string(&nw, PF_T_ANCHOR, filter->pfrt_anchor);
3543 snl_add_msg_attr_string(&nw, PF_T_NAME, filter->pfrt_name);
3544 snl_add_msg_attr_u32(&nw, PF_T_TABLE_FLAGS, filter->pfrt_flags);
3545 snl_add_msg_attr_u32(&nw, PF_T_FLAGS, flags);
3546
3547 if ((hdr = snl_finalize_msg(&nw)) == NULL)
3548 return (ENXIO);
3549
3550 seq_id = hdr->nlmsg_seq;
3551
3552 if (!snl_send_message(&h->ss, hdr))
3553 return (ENXIO);
3554
3555 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
3556 if (!snl_parse_nlmsg(&h->ss, hdr, &clr_addrs_parser, &del))
3557 continue;
3558 if (ndel)
3559 *ndel = (uint32_t)del;
3560 }
3561
3562 return (e.error);
3563 }
3564
3565