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_u16(nw, PF_RT_TYPE_2, r->type);
1288 snl_add_msg_attr_u16(nw, PF_RT_CODE_2, 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 { .type = PF_RT_TYPE_2, .off = _OUT(r.type), .cb = snl_attr_get_uint16 },
1698 { .type = PF_RT_CODE_2, .off = _OUT(r.code), .cb = snl_attr_get_uint16 },
1699 };
1700 #undef _OUT
1701 SNL_DECLARE_PARSER(getrule_parser, struct genlmsghdr, snl_f_p_empty, ap_getrule);
1702
1703 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)1704 pfctl_get_clear_rule_h(struct pfctl_handle *h, uint32_t nr, uint32_t ticket,
1705 const char *anchor, uint32_t ruleset, struct pfctl_rule *rule,
1706 char *anchor_call, bool clear)
1707 {
1708 struct pfctl_nl_get_rule attrs = {};
1709 struct snl_errmsg_data e = {};
1710 struct nlmsghdr *hdr;
1711 struct snl_writer nw;
1712 uint32_t seq_id;
1713 int family_id;
1714
1715 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
1716 if (family_id == 0)
1717 return (ENOTSUP);
1718
1719 snl_init_writer(&h->ss, &nw);
1720 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_GETRULE);
1721 hdr->nlmsg_flags |= NLM_F_DUMP;
1722
1723 snl_add_msg_attr_string(&nw, PF_GR_ANCHOR, anchor);
1724 snl_add_msg_attr_u8(&nw, PF_GR_ACTION, ruleset);
1725 snl_add_msg_attr_u32(&nw, PF_GR_NR, nr);
1726 snl_add_msg_attr_u32(&nw, PF_GR_TICKET, ticket);
1727 snl_add_msg_attr_u8(&nw, PF_GR_CLEAR, clear);
1728
1729 hdr = snl_finalize_msg(&nw);
1730 if (hdr == NULL)
1731 return (ENOMEM);
1732
1733 seq_id = hdr->nlmsg_seq;
1734 if (! snl_send_message(&h->ss, hdr))
1735 return (ENXIO);
1736
1737 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
1738 if (! snl_parse_nlmsg(&h->ss, hdr, &getrule_parser, &attrs))
1739 continue;
1740 }
1741
1742 memcpy(rule, &attrs.r, sizeof(attrs.r));
1743 strlcpy(anchor_call, attrs.anchor_call, MAXPATHLEN);
1744
1745 return (e.error);
1746 }
1747
1748 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)1749 pfctl_get_clear_rule(int dev, uint32_t nr, uint32_t ticket,
1750 const char *anchor, uint32_t ruleset, struct pfctl_rule *rule,
1751 char *anchor_call, bool clear)
1752 {
1753 nvlist_t *nvl;
1754 int ret;
1755
1756 nvl = nvlist_create(0);
1757 if (nvl == 0)
1758 return (ENOMEM);
1759
1760 nvlist_add_number(nvl, "nr", nr);
1761 nvlist_add_number(nvl, "ticket", ticket);
1762 nvlist_add_string(nvl, "anchor", anchor);
1763 nvlist_add_number(nvl, "ruleset", ruleset);
1764
1765 if (clear)
1766 nvlist_add_bool(nvl, "clear_counter", true);
1767
1768 if ((ret = pfctl_do_ioctl(dev, DIOCGETRULENV, 8192, &nvl)) != 0)
1769 goto out;
1770
1771 pf_nvrule_to_rule(nvlist_get_nvlist(nvl, "rule"), rule);
1772
1773 if (anchor_call)
1774 strlcpy(anchor_call, nvlist_get_string(nvl, "anchor_call"),
1775 MAXPATHLEN);
1776
1777 out:
1778 nvlist_destroy(nvl);
1779 return (ret);
1780 }
1781
1782 int
pfctl_set_keepcounters(int dev,bool keep)1783 pfctl_set_keepcounters(int dev, bool keep)
1784 {
1785 struct pfioc_nv nv;
1786 nvlist_t *nvl;
1787 int ret;
1788
1789 nvl = nvlist_create(0);
1790
1791 nvlist_add_bool(nvl, "keep_counters", keep);
1792
1793 nv.data = nvlist_pack(nvl, &nv.len);
1794 nv.size = nv.len;
1795
1796 nvlist_destroy(nvl);
1797
1798 ret = ioctl(dev, DIOCKEEPCOUNTERS, &nv);
1799
1800 free(nv.data);
1801 return (ret);
1802 }
1803
1804 struct pfctl_creator {
1805 uint32_t id;
1806 };
1807 #define _IN(_field) offsetof(struct genlmsghdr, _field)
1808 #define _OUT(_field) offsetof(struct pfctl_creator, _field)
1809 static struct snl_attr_parser ap_creators[] = {
1810 { .type = PF_ST_CREATORID, .off = _OUT(id), .cb = snl_attr_get_uint32 },
1811 };
1812 #undef _IN
1813 #undef _OUT
1814 SNL_DECLARE_PARSER(creator_parser, struct genlmsghdr, snl_f_p_empty, ap_creators);
1815
1816 static int
pfctl_get_creators_nl(struct snl_state * ss,uint32_t * creators,size_t * len)1817 pfctl_get_creators_nl(struct snl_state *ss, uint32_t *creators, size_t *len)
1818 {
1819
1820 int family_id = snl_get_genl_family(ss, PFNL_FAMILY_NAME);
1821 size_t i = 0;
1822
1823 struct nlmsghdr *hdr;
1824 struct snl_writer nw;
1825
1826 if (family_id == 0)
1827 return (ENOTSUP);
1828
1829 snl_init_writer(ss, &nw);
1830 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_GETCREATORS);
1831 hdr->nlmsg_flags |= NLM_F_DUMP;
1832 hdr = snl_finalize_msg(&nw);
1833 if (hdr == NULL)
1834 return (ENOMEM);
1835 uint32_t seq_id = hdr->nlmsg_seq;
1836
1837 snl_send_message(ss, hdr);
1838
1839 struct snl_errmsg_data e = {};
1840 while ((hdr = snl_read_reply_multi(ss, seq_id, &e)) != NULL) {
1841 struct pfctl_creator c;
1842 bzero(&c, sizeof(c));
1843
1844 if (!snl_parse_nlmsg(ss, hdr, &creator_parser, &c))
1845 continue;
1846
1847 creators[i] = c.id;
1848 i++;
1849 if (i > *len)
1850 return (E2BIG);
1851 }
1852
1853 *len = i;
1854
1855 return (0);
1856 }
1857
1858 int
pfctl_get_creatorids(struct pfctl_handle * h,uint32_t * creators,size_t * len)1859 pfctl_get_creatorids(struct pfctl_handle *h, uint32_t *creators, size_t *len)
1860 {
1861 int error;
1862
1863 error = pfctl_get_creators_nl(&h->ss, creators, len);
1864
1865 return (error);
1866 }
1867
1868 static inline bool
snl_attr_get_pfaddr(struct snl_state * ss __unused,struct nlattr * nla,const void * arg __unused,void * target)1869 snl_attr_get_pfaddr(struct snl_state *ss __unused, struct nlattr *nla,
1870 const void *arg __unused, void *target)
1871 {
1872 memcpy(target, NLA_DATA(nla), NLA_DATA_LEN(nla));
1873 return (true);
1874 }
1875
1876 static inline bool
snl_attr_store_ifname(struct snl_state * ss __unused,struct nlattr * nla,const void * arg __unused,void * target)1877 snl_attr_store_ifname(struct snl_state *ss __unused, struct nlattr *nla,
1878 const void *arg __unused, void *target)
1879 {
1880 size_t maxlen = NLA_DATA_LEN(nla);
1881
1882 if (strnlen((char *)NLA_DATA(nla), maxlen) < maxlen) {
1883 strlcpy(target, (char *)NLA_DATA(nla), maxlen);
1884 return (true);
1885 }
1886 return (false);
1887 }
1888
1889 #define _OUT(_field) offsetof(struct pfctl_state_peer, _field)
1890 static const struct snl_attr_parser nla_p_speer[] = {
1891 { .type = PF_STP_SEQLO, .off = _OUT(seqlo), .cb = snl_attr_get_uint32 },
1892 { .type = PF_STP_SEQHI, .off = _OUT(seqhi), .cb = snl_attr_get_uint32 },
1893 { .type = PF_STP_SEQDIFF, .off = _OUT(seqdiff), .cb = snl_attr_get_uint32 },
1894 { .type = PF_STP_STATE, .off = _OUT(state), .cb = snl_attr_get_uint8 },
1895 { .type = PF_STP_WSCALE, .off = _OUT(wscale), .cb = snl_attr_get_uint8 },
1896 };
1897 SNL_DECLARE_ATTR_PARSER(speer_parser, nla_p_speer);
1898 #undef _OUT
1899
1900 #define _OUT(_field) offsetof(struct pfctl_state_key, _field)
1901 static const struct snl_attr_parser nla_p_skey[] = {
1902 { .type = PF_STK_ADDR0, .off = _OUT(addr[0]), .cb = snl_attr_get_pfaddr },
1903 { .type = PF_STK_ADDR1, .off = _OUT(addr[1]), .cb = snl_attr_get_pfaddr },
1904 { .type = PF_STK_PORT0, .off = _OUT(port[0]), .cb = snl_attr_get_uint16 },
1905 { .type = PF_STK_PORT1, .off = _OUT(port[1]), .cb = snl_attr_get_uint16 },
1906 { .type = PF_STK_AF, .off = _OUT(af), .cb = snl_attr_get_uint8 },
1907 { .type = PF_STK_PROTO, .off = _OUT(proto), .cb = snl_attr_get_uint16 },
1908 };
1909 SNL_DECLARE_ATTR_PARSER(skey_parser, nla_p_skey);
1910 #undef _OUT
1911
1912 #define _IN(_field) offsetof(struct genlmsghdr, _field)
1913 #define _OUT(_field) offsetof(struct pfctl_state, _field)
1914 static struct snl_attr_parser ap_state[] = {
1915 { .type = PF_ST_ID, .off = _OUT(id), .cb = snl_attr_get_uint64 },
1916 { .type = PF_ST_CREATORID, .off = _OUT(creatorid), .cb = snl_attr_get_uint32 },
1917 { .type = PF_ST_IFNAME, .off = _OUT(ifname), .cb = snl_attr_store_ifname },
1918 { .type = PF_ST_ORIG_IFNAME, .off = _OUT(orig_ifname), .cb = snl_attr_store_ifname },
1919 { .type = PF_ST_KEY_WIRE, .off = _OUT(key[0]), .arg = &skey_parser, .cb = snl_attr_get_nested },
1920 { .type = PF_ST_KEY_STACK, .off = _OUT(key[1]), .arg = &skey_parser, .cb = snl_attr_get_nested },
1921 { .type = PF_ST_PEER_SRC, .off = _OUT(src), .arg = &speer_parser, .cb = snl_attr_get_nested },
1922 { .type = PF_ST_PEER_DST, .off = _OUT(dst), .arg = &speer_parser, .cb = snl_attr_get_nested },
1923 { .type = PF_ST_RT_ADDR, .off = _OUT(rt_addr), .cb = snl_attr_get_pfaddr },
1924 { .type = PF_ST_RULE, .off = _OUT(rule), .cb = snl_attr_get_uint32 },
1925 { .type = PF_ST_ANCHOR, .off = _OUT(anchor), .cb = snl_attr_get_uint32 },
1926 { .type = PF_ST_NAT_RULE, .off = _OUT(nat_rule), .cb = snl_attr_get_uint32 },
1927 { .type = PF_ST_CREATION, .off = _OUT(creation), .cb = snl_attr_get_uint32 },
1928 { .type = PF_ST_EXPIRE, .off = _OUT(expire), .cb = snl_attr_get_uint32 },
1929 { .type = PF_ST_PACKETS0, .off = _OUT(packets[0]), .cb = snl_attr_get_uint64 },
1930 { .type = PF_ST_PACKETS1, .off = _OUT(packets[1]), .cb = snl_attr_get_uint64 },
1931 { .type = PF_ST_BYTES0, .off = _OUT(bytes[0]), .cb = snl_attr_get_uint64 },
1932 { .type = PF_ST_BYTES1, .off = _OUT(bytes[1]), .cb = snl_attr_get_uint64 },
1933 { .type = PF_ST_DIRECTION, .off = _OUT(direction), .cb = snl_attr_get_uint8 },
1934 { .type = PF_ST_LOG, .off = _OUT(log), .cb = snl_attr_get_uint8 },
1935 { .type = PF_ST_STATE_FLAGS, .off = _OUT(state_flags), .cb = snl_attr_get_uint16 },
1936 { .type = PF_ST_SYNC_FLAGS, .off = _OUT(sync_flags), .cb = snl_attr_get_uint8 },
1937 { .type = PF_ST_RTABLEID, .off = _OUT(rtableid), .cb = snl_attr_get_int32 },
1938 { .type = PF_ST_MIN_TTL, .off = _OUT(min_ttl), .cb = snl_attr_get_uint8 },
1939 { .type = PF_ST_MAX_MSS, .off = _OUT(max_mss), .cb = snl_attr_get_uint16 },
1940 { .type = PF_ST_DNPIPE, .off = _OUT(dnpipe), .cb = snl_attr_get_uint16 },
1941 { .type = PF_ST_DNRPIPE, .off = _OUT(dnrpipe), .cb = snl_attr_get_uint16 },
1942 { .type = PF_ST_RT, .off = _OUT(rt), .cb = snl_attr_get_uint8 },
1943 { .type = PF_ST_RT_IFNAME, .off = _OUT(rt_ifname), .cb = snl_attr_store_ifname },
1944 { .type = PF_ST_SRC_NODE_FLAGS, .off = _OUT(src_node_flags), .cb = snl_attr_get_uint8 },
1945 { .type = PF_ST_RT_AF, .off = _OUT(rt_af), .cb = snl_attr_get_uint8 },
1946 };
1947 #undef _IN
1948 #undef _OUT
1949 SNL_DECLARE_PARSER(state_parser, struct genlmsghdr, snl_f_p_empty, ap_state);
1950
1951 static const struct snl_hdr_parser *all_parsers[] = {
1952 &state_parser, &skey_parser, &speer_parser,
1953 &creator_parser, &getrules_parser
1954 };
1955
1956 static int
pfctl_get_states_nl(struct pfctl_state_filter * filter,struct snl_state * ss,pfctl_get_state_fn f,void * arg)1957 pfctl_get_states_nl(struct pfctl_state_filter *filter, struct snl_state *ss, pfctl_get_state_fn f, void *arg)
1958 {
1959 SNL_VERIFY_PARSERS(all_parsers);
1960 int family_id = snl_get_genl_family(ss, PFNL_FAMILY_NAME);
1961 int ret;
1962
1963 struct nlmsghdr *hdr;
1964 struct snl_writer nw;
1965
1966 if (family_id == 0)
1967 return (ENOTSUP);
1968
1969 snl_init_writer(ss, &nw);
1970 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_GETSTATES);
1971 hdr->nlmsg_flags |= NLM_F_DUMP;
1972 snl_add_msg_attr_string(&nw, PF_ST_IFNAME, filter->ifname);
1973 snl_add_msg_attr_u16(&nw, PF_ST_PROTO, filter->proto);
1974 snl_add_msg_attr_u8(&nw, PF_ST_AF, filter->af);
1975 snl_add_msg_attr_ip6(&nw, PF_ST_FILTER_ADDR, &filter->addr.v6);
1976 snl_add_msg_attr_ip6(&nw, PF_ST_FILTER_MASK, &filter->mask.v6);
1977
1978 hdr = snl_finalize_msg(&nw);
1979 if (hdr == NULL)
1980 return (ENOMEM);
1981
1982 uint32_t seq_id = hdr->nlmsg_seq;
1983
1984 snl_send_message(ss, hdr);
1985
1986 struct snl_errmsg_data e = {};
1987 while ((hdr = snl_read_reply_multi(ss, seq_id, &e)) != NULL) {
1988 struct pfctl_state s;
1989 bzero(&s, sizeof(s));
1990 if (!snl_parse_nlmsg(ss, hdr, &state_parser, &s))
1991 continue;
1992
1993 ret = f(&s, arg);
1994 if (ret != 0)
1995 return (ret);
1996 }
1997
1998 return (0);
1999 }
2000
2001 int
pfctl_get_states_iter(pfctl_get_state_fn f,void * arg)2002 pfctl_get_states_iter(pfctl_get_state_fn f, void *arg)
2003 {
2004 struct pfctl_state_filter filter = {};
2005 return (pfctl_get_filtered_states_iter(&filter, f, arg));
2006 }
2007
2008 int
pfctl_get_filtered_states_iter(struct pfctl_state_filter * filter,pfctl_get_state_fn f,void * arg)2009 pfctl_get_filtered_states_iter(struct pfctl_state_filter *filter, pfctl_get_state_fn f, void *arg)
2010 {
2011 struct snl_state ss = {};
2012 int error;
2013
2014 snl_init(&ss, NETLINK_GENERIC);
2015 error = pfctl_get_states_nl(filter, &ss, f, arg);
2016 snl_free(&ss);
2017
2018 return (error);
2019 }
2020
2021 static int
pfctl_append_states(struct pfctl_state * s,void * arg)2022 pfctl_append_states(struct pfctl_state *s, void *arg)
2023 {
2024 struct pfctl_state *new;
2025 struct pfctl_states *states = (struct pfctl_states *)arg;
2026
2027 new = malloc(sizeof(*s));
2028 if (new == NULL)
2029 return (ENOMEM);
2030
2031 memcpy(new, s, sizeof(*s));
2032
2033 TAILQ_INSERT_TAIL(&states->states, new, entry);
2034
2035 return (0);
2036 }
2037
2038 int
pfctl_get_states(int dev __unused,struct pfctl_states * states)2039 pfctl_get_states(int dev __unused, struct pfctl_states *states)
2040 {
2041 int ret;
2042
2043 bzero(states, sizeof(*states));
2044 TAILQ_INIT(&states->states);
2045
2046 ret = pfctl_get_states_iter(pfctl_append_states, states);
2047 if (ret != 0) {
2048 pfctl_free_states(states);
2049 return (ret);
2050 }
2051
2052 return (0);
2053 }
2054
2055 void
pfctl_free_states(struct pfctl_states * states)2056 pfctl_free_states(struct pfctl_states *states)
2057 {
2058 struct pfctl_state *s, *tmp;
2059
2060 TAILQ_FOREACH_SAFE(s, &states->states, entry, tmp) {
2061 free(s);
2062 }
2063
2064 bzero(states, sizeof(*states));
2065 }
2066
2067 struct pfctl_nl_clear_states {
2068 uint32_t killed;
2069 };
2070 #define _OUT(_field) offsetof(struct pfctl_nl_clear_states, _field)
2071 static struct snl_attr_parser ap_clear_states[] = {
2072 { .type = PF_CS_KILLED, .off = _OUT(killed), .cb = snl_attr_get_uint32 },
2073 };
2074 #undef _OUT
2075 SNL_DECLARE_PARSER(clear_states_parser, struct genlmsghdr, snl_f_p_empty, ap_clear_states);
2076
2077 static int
_pfctl_clear_states_h(struct pfctl_handle * h,const struct pfctl_kill * kill,unsigned int * killed,int cmd)2078 _pfctl_clear_states_h(struct pfctl_handle *h, const struct pfctl_kill *kill,
2079 unsigned int *killed, int cmd)
2080 {
2081 struct snl_writer nw;
2082 struct snl_errmsg_data e = {};
2083 struct pfctl_nl_clear_states attrs = {};
2084 struct nlmsghdr *hdr;
2085 uint32_t seq_id;
2086 int family_id;
2087
2088 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
2089 if (family_id == 0)
2090 return (ENOTSUP);
2091
2092 snl_init_writer(&h->ss, &nw);
2093 hdr = snl_create_genl_msg_request(&nw, family_id, cmd);
2094 hdr->nlmsg_flags |= NLM_F_DUMP;
2095
2096 snl_add_msg_attr_u64(&nw, PF_CS_CMP_ID, kill->cmp.id);
2097 snl_add_msg_attr_u32(&nw, PF_CS_CMP_CREATORID, htonl(kill->cmp.creatorid));
2098 snl_add_msg_attr_u8(&nw, PF_CS_CMP_DIR, kill->cmp.direction);
2099 snl_add_msg_attr_u8(&nw, PF_CS_AF, kill->af);
2100 snl_add_msg_attr_u8(&nw, PF_CS_PROTO, kill->proto);
2101 snl_add_msg_attr_rule_addr(&nw, PF_CS_SRC, &kill->src);
2102 snl_add_msg_attr_rule_addr(&nw, PF_CS_DST, &kill->dst);
2103 snl_add_msg_attr_rule_addr(&nw, PF_CS_RT_ADDR, &kill->rt_addr);
2104 snl_add_msg_attr_string(&nw, PF_CS_IFNAME, kill->ifname);
2105 snl_add_msg_attr_string(&nw, PF_CS_LABEL, kill->label);
2106 snl_add_msg_attr_bool(&nw, PF_CS_KILL_MATCH, kill->kill_match);
2107 snl_add_msg_attr_bool(&nw, PF_CS_NAT, kill->nat);
2108
2109 if ((hdr = snl_finalize_msg(&nw)) == NULL)
2110 return (ENXIO);
2111
2112 seq_id = hdr->nlmsg_seq;
2113
2114 if (! snl_send_message(&h->ss, hdr))
2115 return (ENXIO);
2116
2117 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
2118 if (! snl_parse_nlmsg(&h->ss, hdr, &clear_states_parser, &attrs))
2119 continue;
2120 }
2121
2122 if (killed)
2123 *killed = attrs.killed;
2124
2125 return (e.error);
2126 }
2127
2128 int
pfctl_clear_states_h(struct pfctl_handle * h,const struct pfctl_kill * kill,unsigned int * killed)2129 pfctl_clear_states_h(struct pfctl_handle *h, const struct pfctl_kill *kill,
2130 unsigned int *killed)
2131 {
2132 return(_pfctl_clear_states_h(h, kill, killed, PFNL_CMD_CLRSTATES));
2133 }
2134
2135 int
pfctl_kill_states_h(struct pfctl_handle * h,const struct pfctl_kill * kill,unsigned int * killed)2136 pfctl_kill_states_h(struct pfctl_handle *h, const struct pfctl_kill *kill,
2137 unsigned int *killed)
2138 {
2139 return(_pfctl_clear_states_h(h, kill, killed, PFNL_CMD_KILLSTATES));
2140 }
2141
2142 static int
_pfctl_clear_states(int dev __unused,const struct pfctl_kill * kill,unsigned int * killed,uint64_t cmd)2143 _pfctl_clear_states(int dev __unused, const struct pfctl_kill *kill,
2144 unsigned int *killed, uint64_t cmd)
2145 {
2146 struct pfctl_handle *h;
2147 int ret;
2148
2149 h = pfctl_open(PF_DEVICE);
2150 if (h == NULL)
2151 return (ENODEV);
2152
2153 ret = _pfctl_clear_states_h(h, kill, killed, cmd);
2154 pfctl_close(h);
2155
2156 return (ret);
2157 }
2158
2159 int
pfctl_clear_states(int dev __unused,const struct pfctl_kill * kill,unsigned int * killed)2160 pfctl_clear_states(int dev __unused, const struct pfctl_kill *kill,
2161 unsigned int *killed)
2162 {
2163 return (_pfctl_clear_states(dev, kill, killed, PFNL_CMD_CLRSTATES));
2164 }
2165
2166 int
pfctl_kill_states(int dev __unused,const struct pfctl_kill * kill,unsigned int * killed)2167 pfctl_kill_states(int dev __unused, const struct pfctl_kill *kill, unsigned int *killed)
2168 {
2169 return (_pfctl_clear_states(dev, kill, killed, PFNL_CMD_KILLSTATES));
2170 }
2171
2172 int
pfctl_clear_rules(int dev,const char * anchorname)2173 pfctl_clear_rules(int dev, const char *anchorname)
2174 {
2175 struct pfioc_trans trans;
2176 struct pfioc_trans_e transe[2];
2177 int ret;
2178
2179 bzero(&trans, sizeof(trans));
2180 bzero(&transe, sizeof(transe));
2181
2182 transe[0].rs_num = PF_RULESET_SCRUB;
2183 if (strlcpy(transe[0].anchor, anchorname, sizeof(transe[0].anchor))
2184 >= sizeof(transe[0].anchor))
2185 return (E2BIG);
2186
2187 transe[1].rs_num = PF_RULESET_FILTER;
2188 if (strlcpy(transe[1].anchor, anchorname, sizeof(transe[1].anchor))
2189 >= sizeof(transe[1].anchor))
2190 return (E2BIG);
2191
2192 trans.size = 2;
2193 trans.esize = sizeof(transe[0]);
2194 trans.array = transe;
2195
2196 ret = ioctl(dev, DIOCXBEGIN, &trans);
2197 if (ret != 0)
2198 return (errno);
2199 ret = ioctl(dev, DIOCXCOMMIT, &trans);
2200 if (ret != 0)
2201 return (errno);
2202
2203 return (0);
2204 }
2205
2206 int
pfctl_clear_nat(int dev,const char * anchorname)2207 pfctl_clear_nat(int dev, const char *anchorname)
2208 {
2209 struct pfioc_trans trans;
2210 struct pfioc_trans_e transe[3];
2211 int ret;
2212
2213 bzero(&trans, sizeof(trans));
2214 bzero(&transe, sizeof(transe));
2215
2216 transe[0].rs_num = PF_RULESET_NAT;
2217 if (strlcpy(transe[0].anchor, anchorname, sizeof(transe[0].anchor))
2218 >= sizeof(transe[0].anchor))
2219 return (E2BIG);
2220
2221 transe[1].rs_num = PF_RULESET_BINAT;
2222 if (strlcpy(transe[1].anchor, anchorname, sizeof(transe[1].anchor))
2223 >= sizeof(transe[0].anchor))
2224 return (E2BIG);
2225
2226 transe[2].rs_num = PF_RULESET_RDR;
2227 if (strlcpy(transe[2].anchor, anchorname, sizeof(transe[2].anchor))
2228 >= sizeof(transe[2].anchor))
2229 return (E2BIG);
2230
2231 trans.size = 3;
2232 trans.esize = sizeof(transe[0]);
2233 trans.array = transe;
2234
2235 ret = ioctl(dev, DIOCXBEGIN, &trans);
2236 if (ret != 0)
2237 return (errno);
2238 ret = ioctl(dev, DIOCXCOMMIT, &trans);
2239 if (ret != 0)
2240 return (errno);
2241
2242 return (0);
2243 }
2244
2245 int
pfctl_clear_eth_rules(int dev,const char * anchorname)2246 pfctl_clear_eth_rules(int dev, const char *anchorname)
2247 {
2248 struct pfioc_trans trans;
2249 struct pfioc_trans_e transe;
2250 int ret;
2251
2252 bzero(&trans, sizeof(trans));
2253 bzero(&transe, sizeof(transe));
2254
2255 transe.rs_num = PF_RULESET_ETH;
2256 if (strlcpy(transe.anchor, anchorname, sizeof(transe.anchor))
2257 >= sizeof(transe.anchor))
2258 return (E2BIG);
2259
2260 trans.size = 1;
2261 trans.esize = sizeof(transe);
2262 trans.array = &transe;
2263
2264 ret = ioctl(dev, DIOCXBEGIN, &trans);
2265 if (ret != 0)
2266 return (errno);
2267 ret = ioctl(dev, DIOCXCOMMIT, &trans);
2268 if (ret != 0)
2269 return (errno);
2270
2271 return (0);
2272 }
2273
2274 static int
_pfctl_get_limit(int dev,const int index,uint * limit)2275 _pfctl_get_limit(int dev, const int index, uint *limit)
2276 {
2277 struct pfioc_limit pl;
2278
2279 bzero(&pl, sizeof(pl));
2280 pl.index = index;
2281
2282 if (ioctl(dev, DIOCGETLIMIT, &pl) == -1)
2283 return (errno);
2284
2285 *limit = pl.limit;
2286
2287 return (0);
2288 }
2289
2290 int
pfctl_set_syncookies(int dev,const struct pfctl_syncookies * s)2291 pfctl_set_syncookies(int dev, const struct pfctl_syncookies *s)
2292 {
2293 struct pfioc_nv nv;
2294 nvlist_t *nvl;
2295 int ret;
2296 uint state_limit;
2297 uint64_t lim, hi, lo;
2298
2299 ret = _pfctl_get_limit(dev, PF_LIMIT_STATES, &state_limit);
2300 if (ret != 0)
2301 return (ret);
2302
2303 if (state_limit == 0)
2304 state_limit = INT_MAX;
2305
2306 lim = state_limit;
2307 hi = lim * s->highwater / 100;
2308 lo = lim * s->lowwater / 100;
2309
2310 if (lo == hi)
2311 hi++;
2312
2313 nvl = nvlist_create(0);
2314
2315 nvlist_add_bool(nvl, "enabled", s->mode != PFCTL_SYNCOOKIES_NEVER);
2316 nvlist_add_bool(nvl, "adaptive", s->mode == PFCTL_SYNCOOKIES_ADAPTIVE);
2317 nvlist_add_number(nvl, "highwater", hi);
2318 nvlist_add_number(nvl, "lowwater", lo);
2319
2320 nv.data = nvlist_pack(nvl, &nv.len);
2321 nv.size = nv.len;
2322 nvlist_destroy(nvl);
2323 nvl = NULL;
2324
2325 ret = ioctl(dev, DIOCSETSYNCOOKIES, &nv);
2326
2327 free(nv.data);
2328 if (ret != 0)
2329 return (errno);
2330
2331 return (0);
2332 }
2333
2334 int
pfctl_get_syncookies(int dev,struct pfctl_syncookies * s)2335 pfctl_get_syncookies(int dev, struct pfctl_syncookies *s)
2336 {
2337 nvlist_t *nvl;
2338 int ret;
2339 uint state_limit;
2340 bool enabled, adaptive;
2341
2342 ret = _pfctl_get_limit(dev, PF_LIMIT_STATES, &state_limit);
2343 if (ret != 0)
2344 return (ret);
2345
2346 if (state_limit == 0)
2347 state_limit = INT_MAX;
2348
2349 bzero(s, sizeof(*s));
2350
2351 nvl = nvlist_create(0);
2352
2353 if ((ret = pfctl_do_ioctl(dev, DIOCGETSYNCOOKIES, 256, &nvl)) != 0) {
2354 ret = errno;
2355 goto out;
2356 }
2357
2358 enabled = nvlist_get_bool(nvl, "enabled");
2359 adaptive = nvlist_get_bool(nvl, "adaptive");
2360
2361 if (enabled) {
2362 if (adaptive)
2363 s->mode = PFCTL_SYNCOOKIES_ADAPTIVE;
2364 else
2365 s->mode = PFCTL_SYNCOOKIES_ALWAYS;
2366 } else {
2367 s->mode = PFCTL_SYNCOOKIES_NEVER;
2368 }
2369
2370 s->highwater = nvlist_get_number(nvl, "highwater") * 100 / state_limit;
2371 s->lowwater = nvlist_get_number(nvl, "lowwater") * 100 / state_limit;
2372 s->halfopen_states = nvlist_get_number(nvl, "halfopen_states");
2373
2374 out:
2375 nvlist_destroy(nvl);
2376 return (ret);
2377 }
2378
2379 int
pfctl_table_add_addrs(int dev,struct pfr_table * tbl,struct pfr_addr * addr,int size,int * nadd,int flags)2380 pfctl_table_add_addrs(int dev, struct pfr_table *tbl, struct pfr_addr
2381 *addr, int size, int *nadd, int flags)
2382 {
2383 struct pfioc_table io;
2384
2385 if (tbl == NULL || size < 0 || (size && addr == NULL)) {
2386 return (EINVAL);
2387 }
2388 bzero(&io, sizeof io);
2389 io.pfrio_flags = flags;
2390 io.pfrio_table = *tbl;
2391 io.pfrio_buffer = addr;
2392 io.pfrio_esize = sizeof(*addr);
2393 io.pfrio_size = size;
2394
2395 if (ioctl(dev, DIOCRADDADDRS, &io))
2396 return (errno);
2397 if (nadd != NULL)
2398 *nadd = io.pfrio_nadd;
2399 return (0);
2400 }
2401
2402 static void
snl_add_msg_attr_table(struct snl_writer * nw,uint32_t type,const struct pfr_table * tbl)2403 snl_add_msg_attr_table(struct snl_writer *nw, uint32_t type,
2404 const struct pfr_table *tbl)
2405 {
2406 int off;
2407
2408 off = snl_add_msg_attr_nested(nw, type);
2409
2410 snl_add_msg_attr_string(nw, PF_T_ANCHOR, tbl->pfrt_anchor);
2411 snl_add_msg_attr_string(nw, PF_T_NAME, tbl->pfrt_name);
2412 snl_add_msg_attr_u32(nw, PF_T_TABLE_FLAGS, tbl->pfrt_flags);
2413
2414 snl_end_attr_nested(nw, off);
2415 }
2416
2417 static void
snl_add_msg_attr_pfr_addr(struct snl_writer * nw,uint32_t type,const struct pfr_addr * addr)2418 snl_add_msg_attr_pfr_addr(struct snl_writer *nw, uint32_t type,
2419 const struct pfr_addr *addr)
2420 {
2421 int off;
2422
2423 off = snl_add_msg_attr_nested(nw, type);
2424
2425 snl_add_msg_attr_u8(nw, PFR_A_AF, addr->pfra_af);
2426 snl_add_msg_attr_u8(nw, PFR_A_NET, addr->pfra_net);
2427 snl_add_msg_attr_bool(nw, PFR_A_NOT, addr->pfra_not);
2428 snl_add_msg_attr_ip6(nw, PFR_A_ADDR, &addr->pfra_ip6addr);
2429
2430 snl_end_attr_nested(nw, off);
2431 }
2432
2433 static struct snl_attr_parser ap_table_add_addr[] = {
2434 { .type = PF_TA_NBR_ADDED, .off = 0, .cb = snl_attr_get_uint32 },
2435 };
2436 SNL_DECLARE_PARSER(table_add_addr_parser, struct genlmsghdr, snl_f_p_empty, ap_table_add_addr);
2437
2438 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)2439 _pfctl_table_add_addrs_h(struct pfctl_handle *h, struct pfr_table *tbl, struct pfr_addr
2440 *addrs, int size, int *nadd, int flags)
2441 {
2442 struct snl_writer nw;
2443 struct snl_errmsg_data e = {};
2444 struct nlmsghdr *hdr;
2445 uint32_t seq_id;
2446 uint32_t added;
2447 int family_id;
2448
2449 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
2450 if (family_id == 0)
2451 return (ENOTSUP);
2452
2453 snl_init_writer(&h->ss, &nw);
2454 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_TABLE_ADD_ADDR);
2455
2456 snl_add_msg_attr_table(&nw, PF_TA_TABLE, tbl);
2457 snl_add_msg_attr_u32(&nw, PF_TA_FLAGS, flags);
2458 for (int i = 0; i < size; i++)
2459 snl_add_msg_attr_pfr_addr(&nw, PF_TA_ADDR, &addrs[i]);
2460
2461 if ((hdr = snl_finalize_msg(&nw)) == NULL)
2462 return (ENXIO);
2463 seq_id = hdr->nlmsg_seq;
2464
2465 if (! snl_send_message(&h->ss, hdr))
2466 return (ENXIO);
2467
2468 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
2469 if (! snl_parse_nlmsg(&h->ss, hdr, &table_add_addr_parser, &added))
2470 continue;
2471 }
2472
2473 if (nadd)
2474 *nadd = added;
2475
2476 return (e.error);
2477 }
2478
2479 int
pfctl_table_add_addrs_h(struct pfctl_handle * h,struct pfr_table * tbl,struct pfr_addr * addr,int size,int * nadd,int flags)2480 pfctl_table_add_addrs_h(struct pfctl_handle *h, struct pfr_table *tbl, struct pfr_addr
2481 *addr, int size, int *nadd, int flags)
2482 {
2483 int ret;
2484 int off = 0;
2485 int partial_added;
2486 int chunk_size;
2487
2488 do {
2489 chunk_size = MIN(size - off, 256);
2490 ret = _pfctl_table_add_addrs_h(h, tbl, &addr[off], chunk_size, &partial_added, flags);
2491 if (ret != 0)
2492 break;
2493 if (nadd)
2494 *nadd += partial_added;
2495 off += chunk_size;
2496 } while (off < size);
2497
2498 return (ret);
2499 }
2500
2501 static struct snl_attr_parser ap_table_del_addr[] = {
2502 { .type = PF_TA_NBR_DELETED, .off = 0, .cb = snl_attr_get_uint32 },
2503 };
2504 SNL_DECLARE_PARSER(table_del_addr_parser, struct genlmsghdr, snl_f_p_empty, ap_table_del_addr);
2505 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)2506 _pfctl_table_del_addrs_h(struct pfctl_handle *h, struct pfr_table *tbl, struct pfr_addr
2507 *addrs, int size, int *ndel, int flags)
2508 {
2509 struct snl_writer nw;
2510 struct snl_errmsg_data e = {};
2511 struct nlmsghdr *hdr;
2512 uint32_t seq_id;
2513 uint32_t deleted;
2514 int family_id;
2515
2516 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
2517 if (family_id == 0)
2518 return (ENOTSUP);
2519
2520 snl_init_writer(&h->ss, &nw);
2521 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_TABLE_DEL_ADDR);
2522
2523 snl_add_msg_attr_table(&nw, PF_TA_TABLE, tbl);
2524 snl_add_msg_attr_u32(&nw, PF_TA_FLAGS, flags);
2525 for (int i = 0; i < size; i++)
2526 snl_add_msg_attr_pfr_addr(&nw, PF_TA_ADDR, &addrs[i]);
2527
2528 if ((hdr = snl_finalize_msg(&nw)) == NULL)
2529 return (ENXIO);
2530 seq_id = hdr->nlmsg_seq;
2531
2532 if (! snl_send_message(&h->ss, hdr))
2533 return (ENXIO);
2534
2535 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
2536 if (! snl_parse_nlmsg(&h->ss, hdr, &table_del_addr_parser, &deleted))
2537 continue;
2538 }
2539
2540 if (ndel)
2541 *ndel = deleted;
2542
2543 return (e.error);
2544 }
2545
2546 int
pfctl_table_del_addrs(int dev,struct pfr_table * tbl,struct pfr_addr * addr,int size,int * ndel,int flags)2547 pfctl_table_del_addrs(int dev, struct pfr_table *tbl, struct pfr_addr
2548 *addr, int size, int *ndel, int flags)
2549 {
2550 struct pfioc_table io;
2551
2552 if (tbl == NULL || size < 0 || (size && addr == NULL)) {
2553 return (EINVAL);
2554 }
2555 bzero(&io, sizeof io);
2556 io.pfrio_flags = flags;
2557 io.pfrio_table = *tbl;
2558 io.pfrio_buffer = addr;
2559 io.pfrio_esize = sizeof(*addr);
2560 io.pfrio_size = size;
2561
2562 if (ioctl(dev, DIOCRDELADDRS, &io))
2563 return (errno);
2564 if (ndel != NULL)
2565 *ndel = io.pfrio_ndel;
2566 return (0);
2567 }
2568
2569 int
pfctl_table_del_addrs_h(struct pfctl_handle * h,struct pfr_table * tbl,struct pfr_addr * addr,int size,int * ndel,int flags)2570 pfctl_table_del_addrs_h(struct pfctl_handle *h, struct pfr_table *tbl, struct pfr_addr
2571 *addr, int size, int *ndel, int flags)
2572 {
2573 int ret;
2574 int off = 0;
2575 int partial_deleted;
2576 int chunk_size;
2577
2578 do {
2579 chunk_size = MIN(size - off, 256);
2580 ret = _pfctl_table_del_addrs_h(h, tbl, &addr[off], chunk_size,
2581 &partial_deleted, flags);
2582 if (ret != 0)
2583 break;
2584 if (ndel)
2585 *ndel += partial_deleted;
2586 off += chunk_size;
2587 } while (off < size);
2588
2589 return (ret);
2590 }
2591
2592 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)2593 pfctl_table_set_addrs(int dev, struct pfr_table *tbl, struct pfr_addr
2594 *addr, int size, int *size2, int *nadd, int *ndel, int *nchange, int flags)
2595 {
2596 struct pfioc_table io;
2597
2598 if (tbl == NULL || size < 0 || (size && addr == NULL)) {
2599 return (EINVAL);
2600 }
2601 bzero(&io, sizeof io);
2602 io.pfrio_flags = flags;
2603 io.pfrio_table = *tbl;
2604 io.pfrio_buffer = addr;
2605 io.pfrio_esize = sizeof(*addr);
2606 io.pfrio_size = size;
2607 io.pfrio_size2 = (size2 != NULL) ? *size2 : 0;
2608 if (ioctl(dev, DIOCRSETADDRS, &io))
2609 return (errno);
2610 if (nadd != NULL)
2611 *nadd = io.pfrio_nadd;
2612 if (ndel != NULL)
2613 *ndel = io.pfrio_ndel;
2614 if (nchange != NULL)
2615 *nchange = io.pfrio_nchange;
2616 if (size2 != NULL)
2617 *size2 = io.pfrio_size2;
2618 return (0);
2619 }
2620
pfctl_table_get_addrs(int dev,struct pfr_table * tbl,struct pfr_addr * addr,int * size,int flags)2621 int pfctl_table_get_addrs(int dev, struct pfr_table *tbl, struct pfr_addr *addr,
2622 int *size, int flags)
2623 {
2624 struct pfioc_table io;
2625
2626 if (tbl == NULL || size == NULL || *size < 0 ||
2627 (*size && addr == NULL)) {
2628 return (EINVAL);
2629 }
2630 bzero(&io, sizeof io);
2631 io.pfrio_flags = flags;
2632 io.pfrio_table = *tbl;
2633 io.pfrio_buffer = addr;
2634 io.pfrio_esize = sizeof(*addr);
2635 io.pfrio_size = *size;
2636 if (ioctl(dev, DIOCRGETADDRS, &io))
2637 return (errno);
2638 *size = io.pfrio_size;
2639 return (0);
2640 }
2641
2642 int
pfctl_set_statusif(struct pfctl_handle * h,const char * ifname)2643 pfctl_set_statusif(struct pfctl_handle *h, const char *ifname)
2644 {
2645 struct snl_writer nw;
2646 struct snl_errmsg_data e = {};
2647 struct nlmsghdr *hdr;
2648 uint32_t seq_id;
2649 int family_id;
2650
2651 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
2652 if (family_id == 0)
2653 return (ENOTSUP);
2654
2655 snl_init_writer(&h->ss, &nw);
2656 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_SET_STATUSIF);
2657
2658 snl_add_msg_attr_string(&nw, PF_SS_IFNAME, ifname);
2659
2660 if ((hdr = snl_finalize_msg(&nw)) == NULL)
2661 return (ENXIO);
2662
2663 seq_id = hdr->nlmsg_seq;
2664
2665 if (! snl_send_message(&h->ss, hdr))
2666 return (ENXIO);
2667
2668 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
2669 }
2670
2671 return (e.error);
2672 }
2673
2674 #define _IN(_field) offsetof(struct genlmsghdr, _field)
2675 #define _OUT(_field) offsetof(struct pfctl_natlook, _field)
2676 static struct snl_attr_parser ap_natlook[] = {
2677 { .type = PF_NL_SRC_ADDR, .off = _OUT(saddr), .cb = snl_attr_get_in6_addr },
2678 { .type = PF_NL_DST_ADDR, .off = _OUT(daddr), .cb = snl_attr_get_in6_addr },
2679 { .type = PF_NL_SRC_PORT, .off = _OUT(sport), .cb = snl_attr_get_uint16 },
2680 { .type = PF_NL_DST_PORT, .off = _OUT(dport), .cb = snl_attr_get_uint16 },
2681 };
2682 #undef _IN
2683 #undef _OUT
2684 SNL_DECLARE_PARSER(natlook_parser, struct genlmsghdr, snl_f_p_empty, ap_natlook);
2685
2686 int
pfctl_natlook(struct pfctl_handle * h,const struct pfctl_natlook_key * k,struct pfctl_natlook * r)2687 pfctl_natlook(struct pfctl_handle *h, const struct pfctl_natlook_key *k,
2688 struct pfctl_natlook *r)
2689 {
2690 struct snl_writer nw;
2691 struct snl_errmsg_data e = {};
2692 struct nlmsghdr *hdr;
2693 uint32_t seq_id;
2694 int family_id;
2695
2696 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
2697 if (family_id == 0)
2698 return (ENOTSUP);
2699
2700 snl_init_writer(&h->ss, &nw);
2701 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_NATLOOK);
2702 hdr->nlmsg_flags |= NLM_F_DUMP;
2703
2704 snl_add_msg_attr_u8(&nw, PF_NL_AF, k->af);
2705 snl_add_msg_attr_u8(&nw, PF_NL_DIRECTION, k->direction);
2706 snl_add_msg_attr_u8(&nw, PF_NL_PROTO, k->proto);
2707 snl_add_msg_attr_ip6(&nw, PF_NL_SRC_ADDR, &k->saddr.v6);
2708 snl_add_msg_attr_ip6(&nw, PF_NL_DST_ADDR, &k->daddr.v6);
2709 snl_add_msg_attr_u16(&nw, PF_NL_SRC_PORT, k->sport);
2710 snl_add_msg_attr_u16(&nw, PF_NL_DST_PORT, k->dport);
2711
2712 if ((hdr = snl_finalize_msg(&nw)) == NULL)
2713 return (ENXIO);
2714
2715 seq_id = hdr->nlmsg_seq;
2716
2717 if (! snl_send_message(&h->ss, hdr))
2718 return (ENXIO);
2719
2720 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
2721 if (! snl_parse_nlmsg(&h->ss, hdr, &natlook_parser, r))
2722 continue;
2723 }
2724
2725 return (e.error);
2726 }
2727
2728 int
pfctl_set_debug(struct pfctl_handle * h,uint32_t level)2729 pfctl_set_debug(struct pfctl_handle *h, uint32_t level)
2730 {
2731 struct snl_writer nw;
2732 struct snl_errmsg_data e = {};
2733 struct nlmsghdr *hdr;
2734 uint32_t seq_id;
2735 int family_id;
2736
2737 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
2738 if (family_id == 0)
2739 return (ENOTSUP);
2740
2741 snl_init_writer(&h->ss, &nw);
2742 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_SET_DEBUG);
2743
2744 snl_add_msg_attr_u32(&nw, PF_SD_LEVEL, level);
2745
2746 if ((hdr = snl_finalize_msg(&nw)) == NULL)
2747 return (ENXIO);
2748
2749 seq_id = hdr->nlmsg_seq;
2750
2751 if (! snl_send_message(&h->ss, hdr))
2752 return (ENXIO);
2753
2754 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
2755 }
2756
2757 return (e.error);
2758 }
2759
2760 int
pfctl_set_timeout(struct pfctl_handle * h,uint32_t timeout,uint32_t seconds)2761 pfctl_set_timeout(struct pfctl_handle *h, uint32_t timeout, uint32_t seconds)
2762 {
2763 struct snl_writer nw;
2764 struct snl_errmsg_data e = {};
2765 struct nlmsghdr *hdr;
2766 uint32_t seq_id;
2767 int family_id;
2768
2769 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
2770 if (family_id == 0)
2771 return (ENOTSUP);
2772
2773 snl_init_writer(&h->ss, &nw);
2774 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_SET_TIMEOUT);
2775
2776 snl_add_msg_attr_u32(&nw, PF_TO_TIMEOUT, timeout);
2777 snl_add_msg_attr_u32(&nw, PF_TO_SECONDS, seconds);
2778
2779 if ((hdr = snl_finalize_msg(&nw)) == NULL)
2780 return (ENXIO);
2781
2782 seq_id = hdr->nlmsg_seq;
2783
2784 if (! snl_send_message(&h->ss, hdr))
2785 return (ENXIO);
2786
2787 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
2788 }
2789
2790 return (e.error);
2791 }
2792
2793 struct pfctl_nl_timeout {
2794 uint32_t seconds;
2795 };
2796 #define _OUT(_field) offsetof(struct pfctl_nl_timeout, _field)
2797 static struct snl_attr_parser ap_get_timeout[] = {
2798 { .type = PF_TO_SECONDS, .off = _OUT(seconds), .cb = snl_attr_get_uint32 },
2799 };
2800 #undef _OUT
2801 SNL_DECLARE_PARSER(get_timeout_parser, struct genlmsghdr, snl_f_p_empty, ap_get_timeout);
2802
2803 int
pfctl_get_timeout(struct pfctl_handle * h,uint32_t timeout,uint32_t * seconds)2804 pfctl_get_timeout(struct pfctl_handle *h, uint32_t timeout, uint32_t *seconds)
2805 {
2806 struct snl_writer nw;
2807 struct pfctl_nl_timeout to = {};
2808 struct snl_errmsg_data e = {};
2809 struct nlmsghdr *hdr;
2810 uint32_t seq_id;
2811 int family_id;
2812
2813 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
2814 if (family_id == 0)
2815 return (ENOTSUP);
2816
2817 snl_init_writer(&h->ss, &nw);
2818 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_GET_TIMEOUT);
2819 hdr->nlmsg_flags |= NLM_F_DUMP;
2820
2821 snl_add_msg_attr_u32(&nw, PF_TO_TIMEOUT, timeout);
2822
2823 if ((hdr = snl_finalize_msg(&nw)) == NULL)
2824 return (ENXIO);
2825
2826 seq_id = hdr->nlmsg_seq;
2827
2828 if (! snl_send_message(&h->ss, hdr))
2829 return (ENXIO);
2830
2831 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
2832 if (! snl_parse_nlmsg(&h->ss, hdr, &get_timeout_parser, &to))
2833 continue;
2834 }
2835
2836 if (seconds != NULL)
2837 *seconds = to.seconds;
2838
2839 return (e.error);
2840 }
2841
2842 int
pfctl_set_limit(struct pfctl_handle * h,const int index,const uint limit)2843 pfctl_set_limit(struct pfctl_handle *h, const int index, const uint limit)
2844 {
2845 struct snl_writer nw;
2846 struct snl_errmsg_data e = {};
2847 struct nlmsghdr *hdr;
2848 uint32_t seq_id;
2849 int family_id;
2850
2851 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
2852 if (family_id == 0)
2853 return (ENOTSUP);
2854
2855 snl_init_writer(&h->ss, &nw);
2856 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_SET_LIMIT);
2857
2858 snl_add_msg_attr_u32(&nw, PF_LI_INDEX, index);
2859 snl_add_msg_attr_u32(&nw, PF_LI_LIMIT, limit);
2860
2861 if ((hdr = snl_finalize_msg(&nw)) == NULL)
2862 return (ENXIO);
2863
2864 seq_id = hdr->nlmsg_seq;
2865
2866 if (! snl_send_message(&h->ss, hdr))
2867 return (ENXIO);
2868
2869 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
2870 }
2871
2872 return (e.error);
2873 }
2874
2875 struct pfctl_nl_limit {
2876 unsigned int limit;
2877 };
2878 #define _OUT(_field) offsetof(struct pfctl_nl_limit, _field)
2879 static struct snl_attr_parser ap_get_limit[] = {
2880 { .type = PF_LI_LIMIT, .off = _OUT(limit), .cb = snl_attr_get_uint32 },
2881 };
2882 #undef _OUT
2883 SNL_DECLARE_PARSER(get_limit_parser, struct genlmsghdr, snl_f_p_empty, ap_get_limit);
2884
2885 int
pfctl_get_limit(struct pfctl_handle * h,const int index,uint * limit)2886 pfctl_get_limit(struct pfctl_handle *h, const int index, uint *limit)
2887 {
2888 struct snl_writer nw;
2889 struct pfctl_nl_limit li = {};
2890 struct snl_errmsg_data e = {};
2891 struct nlmsghdr *hdr;
2892 uint32_t seq_id;
2893 int family_id;
2894
2895 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
2896 if (family_id == 0)
2897 return (ENOTSUP);
2898
2899 snl_init_writer(&h->ss, &nw);
2900 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_GET_LIMIT);
2901 hdr->nlmsg_flags |= NLM_F_DUMP;
2902
2903 snl_add_msg_attr_u32(&nw, PF_LI_INDEX, index);
2904
2905 if ((hdr = snl_finalize_msg(&nw)) == NULL)
2906 return (ENXIO);
2907
2908 seq_id = hdr->nlmsg_seq;
2909
2910 if (! snl_send_message(&h->ss, hdr))
2911 return (ENXIO);
2912
2913 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
2914 if (! snl_parse_nlmsg(&h->ss, hdr, &get_limit_parser, &li))
2915 continue;
2916 }
2917
2918 if (limit != NULL)
2919 *limit = li.limit;
2920
2921 return (e.error);
2922 }
2923
2924 struct pfctl_nl_begin_addrs {
2925 uint32_t ticket;
2926 };
2927 #define _OUT(_field) offsetof(struct pfctl_nl_begin_addrs, _field)
2928 static struct snl_attr_parser ap_begin_addrs[] = {
2929 { .type = PF_BA_TICKET, .off = _OUT(ticket), .cb = snl_attr_get_uint32 },
2930 };
2931 #undef _OUT
2932 SNL_DECLARE_PARSER(begin_addrs_parser, struct genlmsghdr, snl_f_p_empty, ap_begin_addrs);
2933
2934 int
pfctl_begin_addrs(struct pfctl_handle * h,uint32_t * ticket)2935 pfctl_begin_addrs(struct pfctl_handle *h, uint32_t *ticket)
2936 {
2937 struct snl_writer nw;
2938 struct pfctl_nl_begin_addrs attrs = {};
2939 struct snl_errmsg_data e = {};
2940 struct nlmsghdr *hdr;
2941 uint32_t seq_id;
2942 int family_id;
2943
2944 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
2945 if (family_id == 0)
2946 return (ENOTSUP);
2947
2948 snl_init_writer(&h->ss, &nw);
2949 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_BEGIN_ADDRS);
2950 hdr->nlmsg_flags |= NLM_F_DUMP;
2951
2952 if ((hdr = snl_finalize_msg(&nw)) == NULL)
2953 return (ENXIO);
2954
2955 seq_id = hdr->nlmsg_seq;
2956
2957 if (! snl_send_message(&h->ss, hdr))
2958 return (ENXIO);
2959
2960 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
2961 if (! snl_parse_nlmsg(&h->ss, hdr, &begin_addrs_parser, &attrs))
2962 continue;
2963 }
2964
2965 if (ticket != NULL)
2966 *ticket = attrs.ticket;
2967
2968 return (e.error);
2969 }
2970
2971 int
pfctl_add_addr(struct pfctl_handle * h,const struct pfioc_pooladdr * pa,int which)2972 pfctl_add_addr(struct pfctl_handle *h, const struct pfioc_pooladdr *pa, int which)
2973 {
2974 struct snl_writer nw;
2975 struct snl_errmsg_data e = {};
2976 struct nlmsghdr *hdr;
2977 uint32_t seq_id;
2978 int family_id;
2979
2980 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
2981 if (family_id == 0)
2982 return (ENOTSUP);
2983
2984 snl_init_writer(&h->ss, &nw);
2985 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_ADD_ADDR);
2986
2987 snl_add_msg_attr_u32(&nw, PF_AA_ACTION, pa->action);
2988 snl_add_msg_attr_u32(&nw, PF_AA_TICKET, pa->ticket);
2989 snl_add_msg_attr_u32(&nw, PF_AA_NR, pa->nr);
2990 snl_add_msg_attr_u32(&nw, PF_AA_R_NUM, pa->r_num);
2991 snl_add_msg_attr_u8(&nw, PF_AA_R_ACTION, pa->r_action);
2992 snl_add_msg_attr_u8(&nw, PF_AA_R_LAST, pa->r_last);
2993 snl_add_msg_attr_u8(&nw, PF_AA_AF, pa->af);
2994 snl_add_msg_attr_string(&nw, PF_AA_ANCHOR, pa->anchor);
2995 snl_add_msg_attr_pool_addr(&nw, PF_AA_ADDR, &pa->addr);
2996 snl_add_msg_attr_u32(&nw, PF_AA_WHICH, which);
2997
2998 if ((hdr = snl_finalize_msg(&nw)) == NULL)
2999 return (ENXIO);
3000
3001 seq_id = hdr->nlmsg_seq;
3002
3003 if (! snl_send_message(&h->ss, hdr))
3004 return (ENXIO);
3005
3006 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
3007 }
3008
3009 return (e.error);
3010 }
3011
3012 static const struct snl_attr_parser ap_get_addrs[] = {
3013 { .type = PF_AA_NR, .off = 0, .cb = snl_attr_get_uint32 },
3014 };
3015 SNL_DECLARE_PARSER(get_addrs_parser, struct genlmsghdr, snl_f_p_empty, ap_get_addrs);
3016
3017 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)3018 pfctl_get_addrs(struct pfctl_handle *h, uint32_t ticket, uint32_t r_num,
3019 uint8_t r_action, const char *anchor, uint32_t *nr, int which)
3020 {
3021 struct snl_writer nw;
3022 struct snl_errmsg_data e = {};
3023 struct nlmsghdr *hdr;
3024 uint32_t seq_id;
3025 int family_id;
3026
3027 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
3028 if (family_id == 0)
3029 return (ENOTSUP);
3030
3031 snl_init_writer(&h->ss, &nw);
3032 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_GET_ADDRS);
3033
3034 snl_add_msg_attr_u32(&nw, PF_AA_TICKET, ticket);
3035 snl_add_msg_attr_u32(&nw, PF_AA_R_NUM, r_num);
3036 snl_add_msg_attr_u8(&nw, PF_AA_R_ACTION, r_action);
3037 snl_add_msg_attr_string(&nw, PF_AA_ANCHOR, anchor);
3038 snl_add_msg_attr_u32(&nw, PF_AA_WHICH, which);
3039
3040 if ((hdr = snl_finalize_msg(&nw)) == NULL)
3041 return (ENXIO);
3042
3043 seq_id = hdr->nlmsg_seq;
3044
3045 if (! snl_send_message(&h->ss, hdr))
3046 return (ENXIO);
3047
3048 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
3049 if (! snl_parse_nlmsg(&h->ss, hdr, &get_addrs_parser, nr))
3050 continue;
3051 }
3052
3053 return (e.error);
3054 }
3055
3056 #define _OUT(_field) offsetof(struct pf_pooladdr, _field)
3057 static const struct snl_attr_parser ap_pool_addr[] = {
3058 { .type = PF_PA_ADDR, .off = _OUT(addr), .arg = &addr_wrap_parser, .cb = snl_attr_get_nested },
3059 { .type = PF_PA_IFNAME, .off = _OUT(ifname), .arg_u32 = IFNAMSIZ, .cb = snl_attr_copy_string },
3060 };
3061 SNL_DECLARE_ATTR_PARSER(pool_addr_parser, ap_pool_addr);
3062 #undef _OUT
3063
3064 #define _OUT(_field) offsetof(struct pfioc_pooladdr, _field)
3065 static const struct snl_attr_parser ap_get_addr[] = {
3066 { .type = PF_AA_ACTION, .off = _OUT(action), .cb = snl_attr_get_uint32 },
3067 { .type = PF_AA_TICKET, .off = _OUT(ticket), .cb = snl_attr_get_uint32 },
3068 { .type = PF_AA_NR, .off = _OUT(nr), .cb = snl_attr_get_uint32 },
3069 { .type = PF_AA_R_NUM, .off = _OUT(r_num), .cb = snl_attr_get_uint32 },
3070 { .type = PF_AA_R_ACTION, .off = _OUT(r_action), .cb = snl_attr_get_uint8 },
3071 { .type = PF_AA_R_LAST, .off = _OUT(r_last), .cb = snl_attr_get_uint8 },
3072 { .type = PF_AA_AF, .off = _OUT(af), .cb = snl_attr_get_uint8 },
3073 { .type = PF_AA_ANCHOR, .off = _OUT(anchor), .arg_u32 = MAXPATHLEN, .cb = snl_attr_copy_string },
3074 { .type = PF_AA_ADDR, .off = _OUT(addr), .arg = &pool_addr_parser, .cb = snl_attr_get_nested },
3075 };
3076 SNL_DECLARE_PARSER(get_addr_parser, struct genlmsghdr, snl_f_p_empty, ap_get_addr);
3077 #undef _OUT
3078
3079 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)3080 pfctl_get_addr(struct pfctl_handle *h, uint32_t ticket, uint32_t r_num,
3081 uint8_t r_action, const char *anchor, uint32_t nr, struct pfioc_pooladdr *pa,
3082 int which)
3083 {
3084 struct snl_writer nw;
3085 struct snl_errmsg_data e = {};
3086 struct nlmsghdr *hdr;
3087 uint32_t seq_id;
3088 int family_id;
3089
3090 family_id =snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
3091 if (family_id == 0)
3092 return (ENOTSUP);
3093
3094 snl_init_writer(&h->ss, &nw);
3095 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_GET_ADDR);
3096
3097 snl_add_msg_attr_u32(&nw, PF_AA_TICKET, ticket);
3098 snl_add_msg_attr_u32(&nw, PF_AA_R_NUM, r_num);
3099 snl_add_msg_attr_u8(&nw, PF_AA_R_ACTION, r_action);
3100 snl_add_msg_attr_string(&nw, PF_AA_ANCHOR, anchor);
3101 snl_add_msg_attr_u32(&nw, PF_AA_NR, nr);
3102 snl_add_msg_attr_u32(&nw, PF_AA_WHICH, which);
3103
3104 if ((hdr = snl_finalize_msg(&nw)) == NULL)
3105 return (ENXIO);
3106
3107 seq_id = hdr->nlmsg_seq;
3108
3109 if (! snl_send_message(&h->ss, hdr))
3110 return (ENXIO);
3111
3112 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
3113 if (! snl_parse_nlmsg(&h->ss, hdr, &get_addr_parser, pa))
3114 continue;
3115 }
3116
3117 return (e.error);
3118 }
3119
3120 #define _OUT(_field) offsetof(struct pfioc_ruleset, _field)
3121 static const struct snl_attr_parser ap_ruleset[] = {
3122 { .type = PF_RS_NR, .off = _OUT(nr), .cb = snl_attr_get_uint32 },
3123 { .type = PF_RS_NAME, .off = _OUT(name), .arg = (void *)PF_ANCHOR_NAME_SIZE, .cb = snl_attr_copy_string },
3124 };
3125 SNL_DECLARE_PARSER(ruleset_parser, struct genlmsghdr, snl_f_p_empty, ap_ruleset);
3126 #undef _OUT
3127
3128 int
pfctl_get_rulesets(struct pfctl_handle * h,const char * path,uint32_t * nr)3129 pfctl_get_rulesets(struct pfctl_handle *h, const char *path, uint32_t *nr)
3130 {
3131 struct snl_writer nw;
3132 struct snl_errmsg_data e = {};
3133 struct nlmsghdr *hdr;
3134 struct pfioc_ruleset rs = {};
3135 uint32_t seq_id;
3136 int family_id;
3137
3138 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
3139 if (family_id == 0)
3140 return (ENOTSUP);
3141
3142 snl_init_writer(&h->ss, &nw);
3143 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_GET_RULESETS);
3144
3145 snl_add_msg_attr_string(&nw, PF_RS_PATH, path);
3146
3147 if ((hdr = snl_finalize_msg(&nw)) == NULL)
3148 return (ENXIO);
3149
3150 seq_id = hdr->nlmsg_seq;
3151
3152 if (! snl_send_message(&h->ss, hdr))
3153 return (ENXIO);
3154
3155 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
3156 if (! snl_parse_nlmsg(&h->ss, hdr, &ruleset_parser, &rs))
3157 continue;
3158 }
3159
3160 *nr = rs.nr;
3161
3162 return (e.error);
3163 }
3164
3165 int
pfctl_get_ruleset(struct pfctl_handle * h,const char * path,uint32_t nr,struct pfioc_ruleset * rs)3166 pfctl_get_ruleset(struct pfctl_handle *h, const char *path, uint32_t nr, struct pfioc_ruleset *rs)
3167 {
3168 struct snl_writer nw;
3169 struct snl_errmsg_data e = {};
3170 struct nlmsghdr *hdr;
3171 uint32_t seq_id;
3172 int family_id;
3173
3174 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
3175 if (family_id == 0)
3176 return (ENOTSUP);
3177
3178 snl_init_writer(&h->ss, &nw);
3179 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_GET_RULESET);
3180
3181 snl_add_msg_attr_string(&nw, PF_RS_PATH, path);
3182 snl_add_msg_attr_u32(&nw, PF_RS_NR, nr);
3183
3184 if ((hdr = snl_finalize_msg(&nw)) == NULL)
3185 return (ENXIO);
3186
3187 seq_id = hdr->nlmsg_seq;
3188
3189 if (! snl_send_message(&h->ss, hdr))
3190 return (ENXIO);
3191
3192 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
3193 if (! snl_parse_nlmsg(&h->ss, hdr, &ruleset_parser, rs))
3194 continue;
3195 }
3196
3197 return (e.error);
3198 }
3199
3200 #define _OUT(_field) offsetof(struct pfctl_src_node, _field)
3201 static struct snl_attr_parser ap_srcnode[] = {
3202 { .type = PF_SN_ADDR, .off = _OUT(addr), .cb = snl_attr_get_in6_addr },
3203 { .type = PF_SN_RADDR, .off = _OUT(raddr), .cb = snl_attr_get_in6_addr },
3204 { .type = PF_SN_RULE_NR, .off = _OUT(rule), .cb = snl_attr_get_uint32 },
3205 { .type = PF_SN_BYTES_IN, .off = _OUT(bytes[0]), .cb = snl_attr_get_uint64 },
3206 { .type = PF_SN_BYTES_OUT, .off = _OUT(bytes[1]), .cb = snl_attr_get_uint64 },
3207 { .type = PF_SN_PACKETS_IN, .off = _OUT(packets[0]), .cb = snl_attr_get_uint64 },
3208 { .type = PF_SN_PACKETS_OUT, .off = _OUT(packets[1]), .cb = snl_attr_get_uint64 },
3209 { .type = PF_SN_STATES, .off = _OUT(states), .cb = snl_attr_get_uint32 },
3210 { .type = PF_SN_CONNECTIONS, .off = _OUT(conn), .cb = snl_attr_get_uint32 },
3211 { .type = PF_SN_AF, .off = _OUT(af), .cb = snl_attr_get_uint8 },
3212 { .type = PF_SN_RULE_TYPE, .off = _OUT(ruletype), .cb = snl_attr_get_uint8 },
3213 { .type = PF_SN_CREATION, .off = _OUT(creation), .cb = snl_attr_get_uint64 },
3214 { .type = PF_SN_EXPIRE, .off = _OUT(expire), .cb = snl_attr_get_uint64 },
3215 { .type = PF_SN_CONNECTION_RATE, .off = _OUT(conn_rate), .arg = &pfctl_threshold_parser, .cb = snl_attr_get_nested },
3216 { .type = PF_SN_RAF, .off = _OUT(raf), .cb = snl_attr_get_uint8 },
3217 { .type = PF_SN_NODE_TYPE, .off = _OUT(type), .cb = snl_attr_get_uint8 },
3218 };
3219 #undef _OUT
3220 SNL_DECLARE_PARSER(srcnode_parser, struct genlmsghdr, snl_f_p_empty, ap_srcnode);
3221
3222 int
pfctl_get_srcnodes(struct pfctl_handle * h,pfctl_get_srcnode_fn fn,void * arg)3223 pfctl_get_srcnodes(struct pfctl_handle *h, pfctl_get_srcnode_fn fn, void *arg)
3224 {
3225 struct snl_writer nw;
3226 struct pfctl_src_node sn;
3227 struct snl_errmsg_data e = {};
3228 struct nlmsghdr *hdr;
3229 uint32_t seq_id;
3230 int family_id;
3231 int ret;
3232
3233 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
3234 if (family_id == 0)
3235 return (ENOTSUP);
3236
3237 snl_init_writer(&h->ss, &nw);
3238 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_GET_SRCNODES);
3239
3240 if ((hdr = snl_finalize_msg(&nw)) == NULL)
3241 return (ENXIO);
3242
3243 seq_id = hdr->nlmsg_seq;
3244
3245 if (!snl_send_message(&h->ss, hdr))
3246 return (ENXIO);
3247
3248 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
3249 bzero(&sn, sizeof(sn));
3250 if (!snl_parse_nlmsg(&h->ss, hdr, &srcnode_parser, &sn))
3251 continue;
3252
3253 ret = fn(&sn, arg);
3254 if (ret != 0)
3255 return (ret);
3256 }
3257
3258 return (e.error);
3259 }
3260
3261 static struct snl_attr_parser ap_ndel[] = {
3262 { .type = PF_T_NBR_DELETED, .off = 0, .cb = snl_attr_get_uint32 },
3263 };
3264 SNL_DECLARE_PARSER(ndel_parser, struct genlmsghdr, snl_f_p_empty, ap_ndel);
3265
3266 int
pfctl_clear_tables(struct pfctl_handle * h,struct pfr_table * filter,int * ndel,int flags)3267 pfctl_clear_tables(struct pfctl_handle *h, struct pfr_table *filter,
3268 int *ndel, int flags)
3269 {
3270 struct snl_writer nw;
3271 struct snl_errmsg_data e = {};
3272 struct nlmsghdr *hdr;
3273 uint32_t seq_id;
3274 int family_id;
3275
3276 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
3277 if (family_id == 0)
3278 return (ENOTSUP);
3279
3280 snl_init_writer(&h->ss, &nw);
3281 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_CLEAR_TABLES);
3282
3283 snl_add_msg_attr_string(&nw, PF_T_ANCHOR, filter->pfrt_anchor);
3284 snl_add_msg_attr_string(&nw, PF_T_NAME, filter->pfrt_name);
3285 snl_add_msg_attr_u32(&nw, PF_T_TABLE_FLAGS, filter->pfrt_flags);
3286 snl_add_msg_attr_u32(&nw, PF_T_FLAGS, flags);
3287
3288 if ((hdr = snl_finalize_msg(&nw)) == NULL)
3289 return (ENXIO);
3290
3291 seq_id = hdr->nlmsg_seq;
3292
3293 if (!snl_send_message(&h->ss, hdr))
3294 return (ENXIO);
3295
3296 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
3297 if (!snl_parse_nlmsg(&h->ss, hdr, &ndel_parser, ndel))
3298 continue;
3299 }
3300
3301 return (e.error);
3302 }
3303
3304 static struct snl_attr_parser ap_nadd[] = {
3305 { .type = PF_T_NBR_ADDED, .off = 0, .cb = snl_attr_get_uint32 },
3306 };
3307 SNL_DECLARE_PARSER(nadd_parser, struct genlmsghdr, snl_f_p_empty, ap_nadd);
3308 int
pfctl_add_table(struct pfctl_handle * h,struct pfr_table * table,int * nadd,int flags)3309 pfctl_add_table(struct pfctl_handle *h, struct pfr_table *table,
3310 int *nadd, int flags)
3311 {
3312 struct snl_writer nw;
3313 struct snl_errmsg_data e = {};
3314 struct nlmsghdr *hdr;
3315 uint32_t seq_id;
3316 int family_id;
3317
3318 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
3319 if (family_id == 0)
3320 return (ENOTSUP);
3321
3322 snl_init_writer(&h->ss, &nw);
3323 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_ADD_TABLE);
3324
3325 snl_add_msg_attr_string(&nw, PF_T_ANCHOR, table->pfrt_anchor);
3326 snl_add_msg_attr_string(&nw, PF_T_NAME, table->pfrt_name);
3327 snl_add_msg_attr_u32(&nw, PF_T_TABLE_FLAGS, table->pfrt_flags);
3328 snl_add_msg_attr_u32(&nw, PF_T_FLAGS, flags);
3329
3330 if ((hdr = snl_finalize_msg(&nw)) == NULL)
3331 return (ENXIO);
3332
3333 seq_id = hdr->nlmsg_seq;
3334
3335 if (!snl_send_message(&h->ss, hdr))
3336 return (ENXIO);
3337
3338 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
3339 if (!snl_parse_nlmsg(&h->ss, hdr, &nadd_parser, nadd))
3340 continue;
3341 }
3342
3343 return (e.error);
3344 }
3345
3346 int
pfctl_del_table(struct pfctl_handle * h,struct pfr_table * table,int * ndel,int flags)3347 pfctl_del_table(struct pfctl_handle *h, struct pfr_table *table,
3348 int *ndel, int flags)
3349 {
3350 struct snl_writer nw;
3351 struct snl_errmsg_data e = {};
3352 struct nlmsghdr *hdr;
3353 uint32_t seq_id;
3354 int family_id;
3355
3356 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
3357 if (family_id == 0)
3358 return (ENOTSUP);
3359
3360 snl_init_writer(&h->ss, &nw);
3361 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_DEL_TABLE);
3362
3363 snl_add_msg_attr_string(&nw, PF_T_ANCHOR, table->pfrt_anchor);
3364 snl_add_msg_attr_string(&nw, PF_T_NAME, table->pfrt_name);
3365 snl_add_msg_attr_u32(&nw, PF_T_TABLE_FLAGS, table->pfrt_flags);
3366 snl_add_msg_attr_u32(&nw, PF_T_FLAGS, flags);
3367
3368 if ((hdr = snl_finalize_msg(&nw)) == NULL)
3369 return (ENXIO);
3370
3371 seq_id = hdr->nlmsg_seq;
3372
3373 if (!snl_send_message(&h->ss, hdr))
3374 return (ENXIO);
3375
3376 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
3377 if (!snl_parse_nlmsg(&h->ss, hdr, &ndel_parser, ndel))
3378 continue;
3379 }
3380
3381 return (e.error);
3382 }
3383
3384 static bool
snl_attr_get_uint64_into_int_array(struct snl_state * ss,struct nlattr * nla,const void * arg,void * target)3385 snl_attr_get_uint64_into_int_array(struct snl_state *ss, struct nlattr *nla,
3386 const void *arg, void *target)
3387 {
3388 uint64_t *u64target;
3389 struct snl_uint64_array a = {
3390 .count = 0,
3391 .max = (size_t)arg,
3392 };
3393 bool error;
3394
3395 u64target = malloc(a.max * sizeof(uint64_t));
3396 a.array = u64target;
3397
3398 error = snl_parse_header(ss, NLA_DATA(nla), NLA_DATA_LEN(nla), &array_parser, &a);
3399 if (! error)
3400 return (error);
3401
3402 for (size_t i = 0; i < a.count; i++)
3403 ((int *)target)[i] = (int)u64target[i];
3404
3405 free(u64target);
3406
3407 return (true);
3408 }
3409
3410 #define _OUT(_field) offsetof(struct pfr_table, _field)
3411 static const struct snl_attr_parser ap_table[] = {
3412 { .type = PF_T_ANCHOR, .off = _OUT(pfrt_anchor), .arg = (void *)MAXPATHLEN, .cb = snl_attr_copy_string },
3413 { .type = PF_T_NAME, .off = _OUT(pfrt_name), .arg = (void *)PF_TABLE_NAME_SIZE, .cb =snl_attr_copy_string },
3414 { .type = PF_T_TABLE_FLAGS, .off = _OUT(pfrt_flags), .cb = snl_attr_get_uint32 },
3415 };
3416 #undef _OUT
3417 SNL_DECLARE_ATTR_PARSER(table_parser, ap_table);
3418 #define _OUT(_field) offsetof(struct pfr_tstats, _field)
3419 static struct snl_attr_parser ap_tstats[] = {
3420 { .type = PF_TS_TABLE, .off = _OUT(pfrts_t), .arg = &table_parser, .cb = snl_attr_get_nested },
3421 { .type = PF_TS_PACKETS, .off = _OUT(pfrts_packets), .arg = (void *)(PFR_DIR_MAX * PFR_OP_TABLE_MAX), .cb = snl_attr_get_uint64_array},
3422 { .type = PF_TS_BYTES, .off = _OUT(pfrts_bytes), .arg = (void *)(PFR_DIR_MAX * PFR_OP_TABLE_MAX), .cb = snl_attr_get_uint64_array },
3423 { .type = PF_TS_MATCH, .off = _OUT(pfrts_match), .cb = snl_attr_get_uint64 },
3424 {. type = PF_TS_NOMATCH, .off = _OUT(pfrts_nomatch), .cb = snl_attr_get_uint64 },
3425 { .type = PF_TS_TZERO, .off = _OUT(pfrts_tzero), .cb = snl_attr_get_uint64 },
3426 { .type = PF_TS_REFCNT, .off = _OUT(pfrts_cnt), . arg = (void *)PFR_REFCNT_MAX, .cb = snl_attr_get_uint64_into_int_array },
3427 };
3428 #undef _OUT
3429 SNL_DECLARE_PARSER(tstats_parser, struct genlmsghdr, snl_f_p_empty, ap_tstats);
3430
3431 int
pfctl_get_tstats(struct pfctl_handle * h,const struct pfr_table * filter,pfctl_get_tstats_fn fn,void * arg)3432 pfctl_get_tstats(struct pfctl_handle *h, const struct pfr_table *filter,
3433 pfctl_get_tstats_fn fn, void *arg)
3434 {
3435 struct snl_writer nw;
3436 struct snl_errmsg_data e = {};
3437 struct nlmsghdr *hdr;
3438 uint32_t seq_id;
3439 int family_id;
3440 int ret;
3441
3442 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
3443 if (family_id == 0)
3444 return (ENOTSUP);
3445
3446 snl_init_writer(&h->ss, &nw);
3447 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_GET_TSTATS);
3448
3449 snl_add_msg_attr_string(&nw, PF_T_ANCHOR, filter->pfrt_anchor);
3450 snl_add_msg_attr_string(&nw, PF_T_NAME, filter->pfrt_name);
3451 snl_add_msg_attr_u32(&nw, PF_T_TABLE_FLAGS, filter->pfrt_flags);
3452
3453 if ((hdr = snl_finalize_msg(&nw)) == NULL)
3454 return (ENXIO);
3455
3456 seq_id = hdr->nlmsg_seq;
3457
3458 if (!snl_send_message(&h->ss, hdr))
3459 return (ENXIO);
3460
3461 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
3462 struct pfr_tstats tstats = {};
3463
3464 if (!snl_parse_nlmsg(&h->ss, hdr, &tstats_parser, &tstats))
3465 continue;
3466
3467 ret = fn(&tstats, arg);
3468 if (ret != 0)
3469 break;
3470 }
3471
3472 return (e.error);
3473 }
3474
3475 static struct snl_attr_parser ap_tstats_clr[] = {
3476 { .type = PF_TS_NZERO, .off = 0, .cb = snl_attr_get_uint64 },
3477 };
3478 SNL_DECLARE_PARSER(tstats_clr_parser, struct genlmsghdr, snl_f_p_empty, ap_tstats_clr);
3479
3480 int
pfctl_clear_tstats(struct pfctl_handle * h,const struct pfr_table * filter,int * nzero,int flags)3481 pfctl_clear_tstats(struct pfctl_handle *h, const struct pfr_table *filter,
3482 int *nzero, int flags)
3483 {
3484 struct snl_writer nw;
3485 struct snl_errmsg_data e = {};
3486 struct nlmsghdr *hdr;
3487 uint64_t zero;
3488 uint32_t seq_id;
3489 int family_id;
3490
3491 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
3492 if (family_id == 0)
3493 return (ENOTSUP);
3494
3495 snl_init_writer(&h->ss, &nw);
3496 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_CLR_TSTATS);
3497
3498 snl_add_msg_attr_string(&nw, PF_T_ANCHOR, filter->pfrt_anchor);
3499 snl_add_msg_attr_string(&nw, PF_T_NAME, filter->pfrt_name);
3500 snl_add_msg_attr_u32(&nw, PF_T_TABLE_FLAGS, filter->pfrt_flags);
3501 snl_add_msg_attr_u32(&nw, PF_T_FLAGS, flags);
3502
3503 if ((hdr = snl_finalize_msg(&nw)) == NULL)
3504 return (ENXIO);
3505
3506 seq_id = hdr->nlmsg_seq;
3507
3508 if (!snl_send_message(&h->ss, hdr))
3509 return (ENXIO);
3510
3511 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
3512 if (!snl_parse_nlmsg(&h->ss, hdr, &tstats_clr_parser, &zero))
3513 continue;
3514 if (nzero)
3515 *nzero = (uint32_t)zero;
3516 }
3517
3518 return (e.error);
3519 }
3520
3521 static struct snl_attr_parser ap_clr_addrs[] = {
3522 { .type = PF_T_NBR_DELETED, .off = 0, .cb = snl_attr_get_uint64 },
3523 };
3524 SNL_DECLARE_PARSER(clr_addrs_parser, struct genlmsghdr, snl_f_p_empty, ap_clr_addrs);
3525
3526 int
pfctl_clear_addrs(struct pfctl_handle * h,const struct pfr_table * filter,int * ndel,int flags)3527 pfctl_clear_addrs(struct pfctl_handle *h, const struct pfr_table *filter,
3528 int *ndel, int flags)
3529 {
3530 struct snl_writer nw;
3531 struct snl_errmsg_data e = {};
3532 struct nlmsghdr *hdr;
3533 uint64_t del;
3534 uint32_t seq_id;
3535 int family_id;
3536
3537 family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
3538 if (family_id == 0)
3539 return (ENOTSUP);
3540
3541 snl_init_writer(&h->ss, &nw);
3542 hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_CLR_ADDRS);
3543
3544 snl_add_msg_attr_string(&nw, PF_T_ANCHOR, filter->pfrt_anchor);
3545 snl_add_msg_attr_string(&nw, PF_T_NAME, filter->pfrt_name);
3546 snl_add_msg_attr_u32(&nw, PF_T_TABLE_FLAGS, filter->pfrt_flags);
3547 snl_add_msg_attr_u32(&nw, PF_T_FLAGS, flags);
3548
3549 if ((hdr = snl_finalize_msg(&nw)) == NULL)
3550 return (ENXIO);
3551
3552 seq_id = hdr->nlmsg_seq;
3553
3554 if (!snl_send_message(&h->ss, hdr))
3555 return (ENXIO);
3556
3557 while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
3558 if (!snl_parse_nlmsg(&h->ss, hdr, &clr_addrs_parser, &del))
3559 continue;
3560 if (ndel)
3561 *ndel = (uint32_t)del;
3562 }
3563
3564 return (e.error);
3565 }
3566
3567