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