xref: /freebsd/lib/libpfctl/libpfctl.c (revision ba2a9207)
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 static struct snl_field_parser fp_getstatus[] = {};
396 SNL_DECLARE_PARSER(getstatus_parser, struct genlmsghdr, fp_getstatus, ap_getstatus);
397 #undef _OUT
398 
399 struct pfctl_status *
pfctl_get_status_h(struct pfctl_handle * h __unused)400 pfctl_get_status_h(struct pfctl_handle *h __unused)
401 {
402 	struct pfctl_status	*status;
403 	struct snl_errmsg_data e = {};
404 	struct nlmsghdr *hdr;
405 	struct snl_writer nw;
406 	uint32_t seq_id;
407 	int family_id;
408 
409 	family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
410 	if (family_id == 0)
411 		return (NULL);
412 
413 	snl_init_writer(&h->ss, &nw);
414 	hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_GET_STATUS);
415 	hdr->nlmsg_flags |= NLM_F_DUMP;
416 
417 	hdr = snl_finalize_msg(&nw);
418 	if (hdr == NULL) {
419 		return (NULL);
420 	}
421 
422 	seq_id = hdr->nlmsg_seq;
423 	if (! snl_send_message(&h->ss, hdr))
424 		return (NULL);
425 
426 	status = calloc(1, sizeof(*status));
427 	if (status == NULL)
428 		return (NULL);
429 	TAILQ_INIT(&status->counters);
430 	TAILQ_INIT(&status->lcounters);
431 	TAILQ_INIT(&status->fcounters);
432 	TAILQ_INIT(&status->scounters);
433 
434 	while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
435 		if (! snl_parse_nlmsg(&h->ss, hdr, &getstatus_parser, status))
436 			continue;
437 	}
438 
439 	return (status);
440 }
441 
442 struct pfctl_status *
pfctl_get_status(int dev)443 pfctl_get_status(int dev)
444 {
445 	struct pfctl_status	*status;
446 	nvlist_t	*nvl;
447 	size_t		 len;
448 	const void	*chksum;
449 
450 	status = calloc(1, sizeof(*status));
451 	if (status == NULL)
452 		return (NULL);
453 
454 	nvl = nvlist_create(0);
455 
456 	if (pfctl_do_ioctl(dev, DIOCGETSTATUSNV, 4096, &nvl)) {
457 		nvlist_destroy(nvl);
458 		free(status);
459 		return (NULL);
460 	}
461 
462 	status->running = nvlist_get_bool(nvl, "running");
463 	status->since = nvlist_get_number(nvl, "since");
464 	status->debug = nvlist_get_number(nvl, "debug");
465 	status->hostid = ntohl(nvlist_get_number(nvl, "hostid"));
466 	status->states = nvlist_get_number(nvl, "states");
467 	status->src_nodes = nvlist_get_number(nvl, "src_nodes");
468 	status->syncookies_active = nvlist_get_bool(nvl, "syncookies_active");
469 	status->reass = nvlist_get_number(nvl, "reass");
470 
471 	strlcpy(status->ifname, nvlist_get_string(nvl, "ifname"),
472 	    IFNAMSIZ);
473 	chksum = nvlist_get_binary(nvl, "chksum", &len);
474 	assert(len == PF_MD5_DIGEST_LENGTH);
475 	memcpy(status->pf_chksum, chksum, len);
476 
477 	_pfctl_get_status_counters(nvlist_get_nvlist(nvl, "counters"),
478 	    &status->counters);
479 	_pfctl_get_status_counters(nvlist_get_nvlist(nvl, "lcounters"),
480 	    &status->lcounters);
481 	_pfctl_get_status_counters(nvlist_get_nvlist(nvl, "fcounters"),
482 	    &status->fcounters);
483 	_pfctl_get_status_counters(nvlist_get_nvlist(nvl, "scounters"),
484 	    &status->scounters);
485 
486 	pf_nvuint_64_array(nvl, "pcounters", 2 * 2 * 2,
487 	    (uint64_t *)status->pcounters, NULL);
488 	pf_nvuint_64_array(nvl, "bcounters", 2 * 2,
489 	    (uint64_t *)status->bcounters, NULL);
490 
491 	nvlist_destroy(nvl);
492 
493 	return (status);
494 }
495 int
pfctl_clear_status(struct pfctl_handle * h)496 pfctl_clear_status(struct pfctl_handle *h)
497 {
498 	return (pfctl_do_netlink_cmd(h, PFNL_CMD_CLEAR_STATUS));
499 }
500 
501 static uint64_t
_pfctl_status_counter(struct pfctl_status_counters * counters,uint64_t id)502 _pfctl_status_counter(struct pfctl_status_counters *counters, uint64_t id)
503 {
504 	struct pfctl_status_counter *c;
505 
506 	TAILQ_FOREACH(c, counters, entry) {
507 		if (c->id == id)
508 			return (c->counter);
509 	}
510 
511 	return (0);
512 }
513 
514 uint64_t
pfctl_status_counter(struct pfctl_status * status,int id)515 pfctl_status_counter(struct pfctl_status *status, int id)
516 {
517 	return (_pfctl_status_counter(&status->counters, id));
518 }
519 
520 uint64_t
pfctl_status_lcounter(struct pfctl_status * status,int id)521 pfctl_status_lcounter(struct pfctl_status *status, int id)
522 {
523 	return (_pfctl_status_counter(&status->lcounters, id));
524 }
525 
526 uint64_t
pfctl_status_fcounter(struct pfctl_status * status,int id)527 pfctl_status_fcounter(struct pfctl_status *status, int id)
528 {
529 	return (_pfctl_status_counter(&status->fcounters, id));
530 }
531 
532 uint64_t
pfctl_status_scounter(struct pfctl_status * status,int id)533 pfctl_status_scounter(struct pfctl_status *status, int id)
534 {
535 	return (_pfctl_status_counter(&status->scounters, id));
536 }
537 
538 void
pfctl_free_status(struct pfctl_status * status)539 pfctl_free_status(struct pfctl_status *status)
540 {
541 	struct pfctl_status_counter *c, *tmp;
542 
543 	if (status == NULL)
544 		return;
545 
546 	TAILQ_FOREACH_SAFE(c, &status->counters, entry, tmp) {
547 		free(c->name);
548 		free(c);
549 	}
550 	TAILQ_FOREACH_SAFE(c, &status->lcounters, entry, tmp) {
551 		free(c->name);
552 		free(c);
553 	}
554 	TAILQ_FOREACH_SAFE(c, &status->fcounters, entry, tmp) {
555 		free(c->name);
556 		free(c);
557 	}
558 	TAILQ_FOREACH_SAFE(c, &status->scounters, entry, tmp) {
559 		free(c->name);
560 		free(c);
561 	}
562 
563 	free(status);
564 }
565 
566 static void
pfctl_nv_add_addr(nvlist_t * nvparent,const char * name,const struct pf_addr * addr)567 pfctl_nv_add_addr(nvlist_t *nvparent, const char *name,
568     const struct pf_addr *addr)
569 {
570 	nvlist_t *nvl = nvlist_create(0);
571 
572 	nvlist_add_binary(nvl, "addr", addr, sizeof(*addr));
573 
574 	nvlist_add_nvlist(nvparent, name, nvl);
575 	nvlist_destroy(nvl);
576 }
577 
578 static void
pf_nvaddr_to_addr(const nvlist_t * nvl,struct pf_addr * addr)579 pf_nvaddr_to_addr(const nvlist_t *nvl, struct pf_addr *addr)
580 {
581 	size_t len;
582 	const void *data;
583 
584 	data = nvlist_get_binary(nvl, "addr", &len);
585 	assert(len == sizeof(struct pf_addr));
586 	memcpy(addr, data, len);
587 }
588 
589 static void
pfctl_nv_add_addr_wrap(nvlist_t * nvparent,const char * name,const struct pf_addr_wrap * addr)590 pfctl_nv_add_addr_wrap(nvlist_t *nvparent, const char *name,
591     const struct pf_addr_wrap *addr)
592 {
593 	nvlist_t *nvl = nvlist_create(0);
594 
595 	nvlist_add_number(nvl, "type", addr->type);
596 	nvlist_add_number(nvl, "iflags", addr->iflags);
597 	if (addr->type == PF_ADDR_DYNIFTL)
598 		nvlist_add_string(nvl, "ifname", addr->v.ifname);
599 	if (addr->type == PF_ADDR_TABLE)
600 		nvlist_add_string(nvl, "tblname", addr->v.tblname);
601 	pfctl_nv_add_addr(nvl, "addr", &addr->v.a.addr);
602 	pfctl_nv_add_addr(nvl, "mask", &addr->v.a.mask);
603 
604 	nvlist_add_nvlist(nvparent, name, nvl);
605 	nvlist_destroy(nvl);
606 }
607 
608 static void
pf_nvaddr_wrap_to_addr_wrap(const nvlist_t * nvl,struct pf_addr_wrap * addr)609 pf_nvaddr_wrap_to_addr_wrap(const nvlist_t *nvl, struct pf_addr_wrap *addr)
610 {
611 	bzero(addr, sizeof(*addr));
612 
613 	addr->type = nvlist_get_number(nvl, "type");
614 	addr->iflags = nvlist_get_number(nvl, "iflags");
615 	if (addr->type == PF_ADDR_DYNIFTL) {
616 		strlcpy(addr->v.ifname, nvlist_get_string(nvl, "ifname"),
617 		    IFNAMSIZ);
618 		addr->p.dyncnt = nvlist_get_number(nvl, "dyncnt");
619 	}
620 	if (addr->type == PF_ADDR_TABLE) {
621 		strlcpy(addr->v.tblname, nvlist_get_string(nvl, "tblname"),
622 		    PF_TABLE_NAME_SIZE);
623 		addr->p.tblcnt = nvlist_get_number(nvl, "tblcnt");
624 	}
625 
626 	pf_nvaddr_to_addr(nvlist_get_nvlist(nvl, "addr"), &addr->v.a.addr);
627 	pf_nvaddr_to_addr(nvlist_get_nvlist(nvl, "mask"), &addr->v.a.mask);
628 }
629 
630 static void
pfctl_nv_add_rule_addr(nvlist_t * nvparent,const char * name,const struct pf_rule_addr * addr)631 pfctl_nv_add_rule_addr(nvlist_t *nvparent, const char *name,
632     const struct pf_rule_addr *addr)
633 {
634 	uint64_t ports[2];
635 	nvlist_t *nvl = nvlist_create(0);
636 
637 	pfctl_nv_add_addr_wrap(nvl, "addr", &addr->addr);
638 	ports[0] = addr->port[0];
639 	ports[1] = addr->port[1];
640 	nvlist_add_number_array(nvl, "port", ports, 2);
641 	nvlist_add_number(nvl, "neg", addr->neg);
642 	nvlist_add_number(nvl, "port_op", addr->port_op);
643 
644 	nvlist_add_nvlist(nvparent, name, nvl);
645 	nvlist_destroy(nvl);
646 }
647 
648 static void
pf_nvrule_addr_to_rule_addr(const nvlist_t * nvl,struct pf_rule_addr * addr)649 pf_nvrule_addr_to_rule_addr(const nvlist_t *nvl, struct pf_rule_addr *addr)
650 {
651 	pf_nvaddr_wrap_to_addr_wrap(nvlist_get_nvlist(nvl, "addr"), &addr->addr);
652 
653 	pf_nvuint_16_array(nvl, "port", 2, addr->port, NULL);
654 	addr->neg = nvlist_get_number(nvl, "neg");
655 	addr->port_op = nvlist_get_number(nvl, "port_op");
656 }
657 
658 static void
pf_nvmape_to_mape(const nvlist_t * nvl,struct pf_mape_portset * mape)659 pf_nvmape_to_mape(const nvlist_t *nvl, struct pf_mape_portset *mape)
660 {
661 	mape->offset = nvlist_get_number(nvl, "offset");
662 	mape->psidlen = nvlist_get_number(nvl, "psidlen");
663 	mape->psid = nvlist_get_number(nvl, "psid");
664 }
665 
666 static void
pf_nvpool_to_pool(const nvlist_t * nvl,struct pfctl_pool * pool)667 pf_nvpool_to_pool(const nvlist_t *nvl, struct pfctl_pool *pool)
668 {
669 	size_t len;
670 	const void *data;
671 
672 	data = nvlist_get_binary(nvl, "key", &len);
673 	assert(len == sizeof(pool->key));
674 	memcpy(&pool->key, data, len);
675 
676 	pf_nvaddr_to_addr(nvlist_get_nvlist(nvl, "counter"), &pool->counter);
677 
678 	pool->tblidx = nvlist_get_number(nvl, "tblidx");
679 	pf_nvuint_16_array(nvl, "proxy_port", 2, pool->proxy_port, NULL);
680 	pool->opts = nvlist_get_number(nvl, "opts");
681 
682 	if (nvlist_exists_nvlist(nvl, "mape"))
683 		pf_nvmape_to_mape(nvlist_get_nvlist(nvl, "mape"), &pool->mape);
684 }
685 
686 static void
pf_nvrule_uid_to_rule_uid(const nvlist_t * nvl,struct pf_rule_uid * uid)687 pf_nvrule_uid_to_rule_uid(const nvlist_t *nvl, struct pf_rule_uid *uid)
688 {
689 	pf_nvuint_32_array(nvl, "uid", 2, uid->uid, NULL);
690 	uid->op = nvlist_get_number(nvl, "op");
691 }
692 
693 static void
pf_nvdivert_to_divert(const nvlist_t * nvl,struct pfctl_rule * rule)694 pf_nvdivert_to_divert(const nvlist_t *nvl, struct pfctl_rule *rule)
695 {
696 	pf_nvaddr_to_addr(nvlist_get_nvlist(nvl, "addr"), &rule->divert.addr);
697 	rule->divert.port = nvlist_get_number(nvl, "port");
698 }
699 
700 static void
pf_nvrule_to_rule(const nvlist_t * nvl,struct pfctl_rule * rule)701 pf_nvrule_to_rule(const nvlist_t *nvl, struct pfctl_rule *rule)
702 {
703 	const uint64_t *skip;
704 	const char *const *labels;
705 	size_t skipcount, labelcount;
706 
707 	rule->nr = nvlist_get_number(nvl, "nr");
708 
709 	pf_nvrule_addr_to_rule_addr(nvlist_get_nvlist(nvl, "src"), &rule->src);
710 	pf_nvrule_addr_to_rule_addr(nvlist_get_nvlist(nvl, "dst"), &rule->dst);
711 
712 	skip = nvlist_get_number_array(nvl, "skip", &skipcount);
713 	assert(skip);
714 	assert(skipcount == PF_SKIP_COUNT);
715 	for (int i = 0; i < PF_SKIP_COUNT; i++)
716 		rule->skip[i].nr = skip[i];
717 
718 	labels = nvlist_get_string_array(nvl, "labels", &labelcount);
719 	assert(labelcount <= PF_RULE_MAX_LABEL_COUNT);
720 	for (size_t i = 0; i < labelcount; i++)
721 		strlcpy(rule->label[i], labels[i], PF_RULE_LABEL_SIZE);
722 	rule->ridentifier = nvlist_get_number(nvl, "ridentifier");
723 	strlcpy(rule->ifname, nvlist_get_string(nvl, "ifname"), IFNAMSIZ);
724 	strlcpy(rule->qname, nvlist_get_string(nvl, "qname"), PF_QNAME_SIZE);
725 	strlcpy(rule->pqname, nvlist_get_string(nvl, "pqname"), PF_QNAME_SIZE);
726 	strlcpy(rule->tagname, nvlist_get_string(nvl, "tagname"),
727 	    PF_TAG_NAME_SIZE);
728 	strlcpy(rule->match_tagname, nvlist_get_string(nvl, "match_tagname"),
729 	    PF_TAG_NAME_SIZE);
730 
731 	strlcpy(rule->overload_tblname, nvlist_get_string(nvl, "overload_tblname"),
732 	    PF_TABLE_NAME_SIZE);
733 
734 	pf_nvpool_to_pool(nvlist_get_nvlist(nvl, "rpool"), &rule->rpool);
735 
736 	rule->evaluations = nvlist_get_number(nvl, "evaluations");
737 	pf_nvuint_64_array(nvl, "packets", 2, rule->packets, NULL);
738 	pf_nvuint_64_array(nvl, "bytes", 2, rule->bytes, NULL);
739 
740 	if (nvlist_exists_number(nvl, "timestamp")) {
741 		rule->last_active_timestamp = nvlist_get_number(nvl, "timestamp");
742 	}
743 
744 	rule->os_fingerprint = nvlist_get_number(nvl, "os_fingerprint");
745 
746 	rule->rtableid = nvlist_get_number(nvl, "rtableid");
747 	pf_nvuint_32_array(nvl, "timeout", PFTM_MAX, rule->timeout, NULL);
748 	rule->max_states = nvlist_get_number(nvl, "max_states");
749 	rule->max_src_nodes = nvlist_get_number(nvl, "max_src_nodes");
750 	rule->max_src_states = nvlist_get_number(nvl, "max_src_states");
751 	rule->max_src_conn = nvlist_get_number(nvl, "max_src_conn");
752 	rule->max_src_conn_rate.limit =
753 	    nvlist_get_number(nvl, "max_src_conn_rate.limit");
754 	rule->max_src_conn_rate.seconds =
755 	    nvlist_get_number(nvl, "max_src_conn_rate.seconds");
756 	rule->qid = nvlist_get_number(nvl, "qid");
757 	rule->pqid = nvlist_get_number(nvl, "pqid");
758 	rule->dnpipe = nvlist_get_number(nvl, "dnpipe");
759 	rule->dnrpipe = nvlist_get_number(nvl, "dnrpipe");
760 	rule->free_flags = nvlist_get_number(nvl, "dnflags");
761 	rule->prob = nvlist_get_number(nvl, "prob");
762 	rule->cuid = nvlist_get_number(nvl, "cuid");
763 	rule->cpid = nvlist_get_number(nvl, "cpid");
764 
765 	rule->return_icmp = nvlist_get_number(nvl, "return_icmp");
766 	rule->return_icmp6 = nvlist_get_number(nvl, "return_icmp6");
767 	rule->max_mss = nvlist_get_number(nvl, "max_mss");
768 	rule->scrub_flags = nvlist_get_number(nvl, "scrub_flags");
769 
770 	pf_nvrule_uid_to_rule_uid(nvlist_get_nvlist(nvl, "uid"), &rule->uid);
771 	pf_nvrule_uid_to_rule_uid(nvlist_get_nvlist(nvl, "gid"),
772 	    (struct pf_rule_uid *)&rule->gid);
773 
774 	rule->rule_flag = nvlist_get_number(nvl, "rule_flag");
775 	rule->action = nvlist_get_number(nvl, "action");
776 	rule->direction = nvlist_get_number(nvl, "direction");
777 	rule->log = nvlist_get_number(nvl, "log");
778 	rule->logif = nvlist_get_number(nvl, "logif");
779 	rule->quick = nvlist_get_number(nvl, "quick");
780 	rule->ifnot = nvlist_get_number(nvl, "ifnot");
781 	rule->match_tag_not = nvlist_get_number(nvl, "match_tag_not");
782 	rule->natpass = nvlist_get_number(nvl, "natpass");
783 
784 	rule->keep_state = nvlist_get_number(nvl, "keep_state");
785 	rule->af = nvlist_get_number(nvl, "af");
786 	rule->proto = nvlist_get_number(nvl, "proto");
787 	rule->type = nvlist_get_number(nvl, "type");
788 	rule->code = nvlist_get_number(nvl, "code");
789 	rule->flags = nvlist_get_number(nvl, "flags");
790 	rule->flagset = nvlist_get_number(nvl, "flagset");
791 	rule->min_ttl = nvlist_get_number(nvl, "min_ttl");
792 	rule->allow_opts = nvlist_get_number(nvl, "allow_opts");
793 	rule->rt = nvlist_get_number(nvl, "rt");
794 	rule->return_ttl  = nvlist_get_number(nvl, "return_ttl");
795 	rule->tos = nvlist_get_number(nvl, "tos");
796 	rule->set_tos = nvlist_get_number(nvl, "set_tos");
797 	rule->anchor_relative = nvlist_get_number(nvl, "anchor_relative");
798 	rule->anchor_wildcard = nvlist_get_number(nvl, "anchor_wildcard");
799 
800 	rule->flush = nvlist_get_number(nvl, "flush");
801 	rule->prio = nvlist_get_number(nvl, "prio");
802 	pf_nvuint_8_array(nvl, "set_prio", 2, rule->set_prio, NULL);
803 
804 	pf_nvdivert_to_divert(nvlist_get_nvlist(nvl, "divert"), rule);
805 
806 	rule->states_cur = nvlist_get_number(nvl, "states_cur");
807 	rule->states_tot = nvlist_get_number(nvl, "states_tot");
808 	rule->src_nodes = nvlist_get_number(nvl, "src_nodes");
809 }
810 
811 static void
pfctl_nveth_addr_to_eth_addr(const nvlist_t * nvl,struct pfctl_eth_addr * addr)812 pfctl_nveth_addr_to_eth_addr(const nvlist_t *nvl, struct pfctl_eth_addr *addr)
813 {
814 	static const u_int8_t EMPTY_MAC[ETHER_ADDR_LEN] = { 0 };
815 	size_t len;
816 	const void *data;
817 
818 	data = nvlist_get_binary(nvl, "addr", &len);
819 	assert(len == sizeof(addr->addr));
820 	memcpy(addr->addr, data, sizeof(addr->addr));
821 
822 	data = nvlist_get_binary(nvl, "mask", &len);
823 	assert(len == sizeof(addr->mask));
824 	memcpy(addr->mask, data, sizeof(addr->mask));
825 
826 	addr->neg = nvlist_get_bool(nvl, "neg");
827 
828 	/* To make checks for 'is this address set?' easier. */
829 	addr->isset = memcmp(addr->addr, EMPTY_MAC, ETHER_ADDR_LEN) != 0;
830 }
831 
832 static nvlist_t *
pfctl_eth_addr_to_nveth_addr(const struct pfctl_eth_addr * addr)833 pfctl_eth_addr_to_nveth_addr(const struct pfctl_eth_addr *addr)
834 {
835 	nvlist_t *nvl;
836 
837 	nvl = nvlist_create(0);
838 	if (nvl == NULL)
839 		return (NULL);
840 
841 	nvlist_add_bool(nvl, "neg", addr->neg);
842 	nvlist_add_binary(nvl, "addr", &addr->addr, ETHER_ADDR_LEN);
843 	nvlist_add_binary(nvl, "mask", &addr->mask, ETHER_ADDR_LEN);
844 
845 	return (nvl);
846 }
847 
848 static void
pfctl_nveth_rule_to_eth_rule(const nvlist_t * nvl,struct pfctl_eth_rule * rule)849 pfctl_nveth_rule_to_eth_rule(const nvlist_t *nvl, struct pfctl_eth_rule *rule)
850 {
851 	const char *const *labels;
852 	size_t labelcount, i;
853 
854 	rule->nr = nvlist_get_number(nvl, "nr");
855 	rule->quick = nvlist_get_bool(nvl, "quick");
856 	strlcpy(rule->ifname, nvlist_get_string(nvl, "ifname"), IFNAMSIZ);
857 	rule->ifnot = nvlist_get_bool(nvl, "ifnot");
858 	rule->direction = nvlist_get_number(nvl, "direction");
859 	rule->proto = nvlist_get_number(nvl, "proto");
860 	strlcpy(rule->match_tagname, nvlist_get_string(nvl, "match_tagname"),
861 	    PF_TAG_NAME_SIZE);
862 	rule->match_tag = nvlist_get_number(nvl, "match_tag");
863 	rule->match_tag_not = nvlist_get_bool(nvl, "match_tag_not");
864 
865 	labels = nvlist_get_string_array(nvl, "labels", &labelcount);
866 	assert(labelcount <= PF_RULE_MAX_LABEL_COUNT);
867 	for (i = 0; i < labelcount; i++)
868 		strlcpy(rule->label[i], labels[i], PF_RULE_LABEL_SIZE);
869 	rule->ridentifier = nvlist_get_number(nvl, "ridentifier");
870 
871 	pfctl_nveth_addr_to_eth_addr(nvlist_get_nvlist(nvl, "src"),
872 	    &rule->src);
873 	pfctl_nveth_addr_to_eth_addr(nvlist_get_nvlist(nvl, "dst"),
874 	    &rule->dst);
875 
876 	pf_nvrule_addr_to_rule_addr(nvlist_get_nvlist(nvl, "ipsrc"),
877 	    &rule->ipsrc);
878 	pf_nvrule_addr_to_rule_addr(nvlist_get_nvlist(nvl, "ipdst"),
879 	    &rule->ipdst);
880 
881 	rule->evaluations = nvlist_get_number(nvl, "evaluations");
882 	rule->packets[0] = nvlist_get_number(nvl, "packets-in");
883 	rule->packets[1] = nvlist_get_number(nvl, "packets-out");
884 	rule->bytes[0] = nvlist_get_number(nvl, "bytes-in");
885 	rule->bytes[1] = nvlist_get_number(nvl, "bytes-out");
886 
887 	if (nvlist_exists_number(nvl, "timestamp")) {
888 		rule->last_active_timestamp = nvlist_get_number(nvl, "timestamp");
889 	}
890 
891 	strlcpy(rule->qname, nvlist_get_string(nvl, "qname"), PF_QNAME_SIZE);
892 	strlcpy(rule->tagname, nvlist_get_string(nvl, "tagname"),
893 	    PF_TAG_NAME_SIZE);
894 
895 	rule->dnpipe = nvlist_get_number(nvl, "dnpipe");
896 	rule->dnflags = nvlist_get_number(nvl, "dnflags");
897 
898 	rule->anchor_relative = nvlist_get_number(nvl, "anchor_relative");
899 	rule->anchor_wildcard = nvlist_get_number(nvl, "anchor_wildcard");
900 
901 	strlcpy(rule->bridge_to, nvlist_get_string(nvl, "bridge_to"),
902 	    IFNAMSIZ);
903 
904 	rule->action = nvlist_get_number(nvl, "action");
905 }
906 
907 int
pfctl_get_eth_rulesets_info(int dev,struct pfctl_eth_rulesets_info * ri,const char * path)908 pfctl_get_eth_rulesets_info(int dev, struct pfctl_eth_rulesets_info *ri,
909     const char *path)
910 {
911 	nvlist_t *nvl;
912 	int ret;
913 
914 	bzero(ri, sizeof(*ri));
915 
916 	nvl = nvlist_create(0);
917 	nvlist_add_string(nvl, "path", path);
918 
919 	if ((ret = pfctl_do_ioctl(dev, DIOCGETETHRULESETS, 256, &nvl)) != 0)
920 		goto out;
921 
922 	ri->nr = nvlist_get_number(nvl, "nr");
923 
924 out:
925 	nvlist_destroy(nvl);
926 	return (ret);
927 }
928 
929 int
pfctl_get_eth_ruleset(int dev,const char * path,int nr,struct pfctl_eth_ruleset_info * ri)930 pfctl_get_eth_ruleset(int dev, const char *path, int nr,
931     struct pfctl_eth_ruleset_info *ri)
932 {
933 	nvlist_t *nvl;
934 	int ret;
935 
936 	bzero(ri, sizeof(*ri));
937 
938 	nvl = nvlist_create(0);
939 	nvlist_add_string(nvl, "path", path);
940 	nvlist_add_number(nvl, "nr", nr);
941 
942 	if ((ret = pfctl_do_ioctl(dev, DIOCGETETHRULESET, 1024, &nvl)) != 0)
943 		goto out;
944 
945 	ri->nr = nvlist_get_number(nvl, "nr");
946 	strlcpy(ri->path, nvlist_get_string(nvl, "path"), MAXPATHLEN);
947 	strlcpy(ri->name, nvlist_get_string(nvl, "name"),
948 	    PF_ANCHOR_NAME_SIZE);
949 
950 out:
951 	nvlist_destroy(nvl);
952 	return (ret);
953 }
954 
955 int
pfctl_get_eth_rules_info(int dev,struct pfctl_eth_rules_info * rules,const char * path)956 pfctl_get_eth_rules_info(int dev, struct pfctl_eth_rules_info *rules,
957     const char *path)
958 {
959 	nvlist_t *nvl;
960 	int ret;
961 
962 	bzero(rules, sizeof(*rules));
963 
964 	nvl = nvlist_create(0);
965 	nvlist_add_string(nvl, "anchor", path);
966 
967 	if ((ret = pfctl_do_ioctl(dev, DIOCGETETHRULES, 1024, &nvl)) != 0)
968 		goto out;
969 
970 	rules->nr = nvlist_get_number(nvl, "nr");
971 	rules->ticket = nvlist_get_number(nvl, "ticket");
972 
973 out:
974 	nvlist_destroy(nvl);
975 	return (ret);
976 }
977 
978 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)979 pfctl_get_eth_rule(int dev, uint32_t nr, uint32_t ticket,
980     const char *path, struct pfctl_eth_rule *rule, bool clear,
981     char *anchor_call)
982 {
983 	nvlist_t *nvl;
984 	int ret;
985 
986 	nvl = nvlist_create(0);
987 
988 	nvlist_add_string(nvl, "anchor", path);
989 	nvlist_add_number(nvl, "ticket", ticket);
990 	nvlist_add_number(nvl, "nr", nr);
991 	nvlist_add_bool(nvl, "clear", clear);
992 
993 	if ((ret = pfctl_do_ioctl(dev, DIOCGETETHRULE, 4096, &nvl)) != 0)
994 		goto out;
995 
996 	pfctl_nveth_rule_to_eth_rule(nvl, rule);
997 
998 	if (anchor_call)
999 		strlcpy(anchor_call, nvlist_get_string(nvl, "anchor_call"),
1000 		    MAXPATHLEN);
1001 
1002 out:
1003 	nvlist_destroy(nvl);
1004 	return (ret);
1005 }
1006 
1007 int
pfctl_add_eth_rule(int dev,const struct pfctl_eth_rule * r,const char * anchor,const char * anchor_call,uint32_t ticket)1008 pfctl_add_eth_rule(int dev, const struct pfctl_eth_rule *r, const char *anchor,
1009     const char *anchor_call, uint32_t ticket)
1010 {
1011 	struct pfioc_nv nv;
1012 	nvlist_t *nvl, *addr;
1013 	void *packed;
1014 	int error = 0;
1015 	size_t labelcount, size;
1016 
1017 	nvl = nvlist_create(0);
1018 
1019 	nvlist_add_number(nvl, "ticket", ticket);
1020 	nvlist_add_string(nvl, "anchor", anchor);
1021 	nvlist_add_string(nvl, "anchor_call", anchor_call);
1022 
1023 	nvlist_add_number(nvl, "nr", r->nr);
1024 	nvlist_add_bool(nvl, "quick", r->quick);
1025 	nvlist_add_string(nvl, "ifname", r->ifname);
1026 	nvlist_add_bool(nvl, "ifnot", r->ifnot);
1027 	nvlist_add_number(nvl, "direction", r->direction);
1028 	nvlist_add_number(nvl, "proto", r->proto);
1029 	nvlist_add_string(nvl, "match_tagname", r->match_tagname);
1030 	nvlist_add_bool(nvl, "match_tag_not", r->match_tag_not);
1031 
1032 	addr = pfctl_eth_addr_to_nveth_addr(&r->src);
1033 	if (addr == NULL) {
1034 		nvlist_destroy(nvl);
1035 		return (ENOMEM);
1036 	}
1037 	nvlist_add_nvlist(nvl, "src", addr);
1038 	nvlist_destroy(addr);
1039 
1040 	addr = pfctl_eth_addr_to_nveth_addr(&r->dst);
1041 	if (addr == NULL) {
1042 		nvlist_destroy(nvl);
1043 		return (ENOMEM);
1044 	}
1045 	nvlist_add_nvlist(nvl, "dst", addr);
1046 	nvlist_destroy(addr);
1047 
1048 	pfctl_nv_add_rule_addr(nvl, "ipsrc", &r->ipsrc);
1049 	pfctl_nv_add_rule_addr(nvl, "ipdst", &r->ipdst);
1050 
1051 	labelcount = 0;
1052 	while (labelcount < PF_RULE_MAX_LABEL_COUNT &&
1053 	    r->label[labelcount][0] != 0) {
1054 		nvlist_append_string_array(nvl, "labels",
1055 		    r->label[labelcount]);
1056 		labelcount++;
1057 	}
1058 	nvlist_add_number(nvl, "ridentifier", r->ridentifier);
1059 
1060 	nvlist_add_string(nvl, "qname", r->qname);
1061 	nvlist_add_string(nvl, "tagname", r->tagname);
1062 	nvlist_add_number(nvl, "dnpipe", r->dnpipe);
1063 	nvlist_add_number(nvl, "dnflags", r->dnflags);
1064 
1065 	nvlist_add_string(nvl, "bridge_to", r->bridge_to);
1066 
1067 	nvlist_add_number(nvl, "action", r->action);
1068 
1069 	packed = nvlist_pack(nvl, &size);
1070 	if (packed == NULL) {
1071 		nvlist_destroy(nvl);
1072 		return (ENOMEM);
1073 	}
1074 
1075 	nv.len = size;
1076 	nv.size = size;
1077 	nv.data = packed;
1078 
1079 	if (ioctl(dev, DIOCADDETHRULE, &nv) != 0)
1080 		error = errno;
1081 
1082 	free(packed);
1083 	nvlist_destroy(nvl);
1084 
1085 	return (error);
1086 }
1087 
1088 static void
snl_add_msg_attr_addr_wrap(struct snl_writer * nw,uint32_t type,const struct pf_addr_wrap * addr)1089 snl_add_msg_attr_addr_wrap(struct snl_writer *nw, uint32_t type, const struct pf_addr_wrap *addr)
1090 {
1091 	int off;
1092 
1093 	off = snl_add_msg_attr_nested(nw, type);
1094 
1095 	snl_add_msg_attr_ip6(nw, PF_AT_ADDR, &addr->v.a.addr.v6);
1096 	snl_add_msg_attr_ip6(nw, PF_AT_MASK, &addr->v.a.mask.v6);
1097 
1098 	if (addr->type == PF_ADDR_DYNIFTL)
1099 		snl_add_msg_attr_string(nw, PF_AT_IFNAME, addr->v.ifname);
1100 	if (addr->type == PF_ADDR_TABLE)
1101 		snl_add_msg_attr_string(nw, PF_AT_TABLENAME, addr->v.tblname);
1102 	snl_add_msg_attr_u8(nw, PF_AT_TYPE, addr->type);
1103 	snl_add_msg_attr_u8(nw, PF_AT_IFLAGS, addr->iflags);
1104 
1105 	snl_end_attr_nested(nw, off);
1106 }
1107 
1108 static void
snl_add_msg_attr_rule_addr(struct snl_writer * nw,uint32_t type,const struct pf_rule_addr * addr)1109 snl_add_msg_attr_rule_addr(struct snl_writer *nw, uint32_t type, const struct pf_rule_addr *addr)
1110 {
1111 	int off;
1112 
1113 	off = snl_add_msg_attr_nested(nw, type);
1114 
1115 	snl_add_msg_attr_addr_wrap(nw, PF_RAT_ADDR, &addr->addr);
1116 	snl_add_msg_attr_u16(nw, PF_RAT_SRC_PORT, addr->port[0]);
1117 	snl_add_msg_attr_u16(nw, PF_RAT_DST_PORT, addr->port[1]);
1118 	snl_add_msg_attr_u8(nw, PF_RAT_NEG, addr->neg);
1119 	snl_add_msg_attr_u8(nw, PF_RAT_OP, addr->port_op);
1120 
1121 	snl_end_attr_nested(nw, off);
1122 }
1123 
1124 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])1125 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])
1126 {
1127 	int off, i = 0;
1128 
1129 	off = snl_add_msg_attr_nested(nw, type);
1130 
1131 	while (i < PF_RULE_MAX_LABEL_COUNT &&
1132 	    labels[i][0] != 0) {
1133 		snl_add_msg_attr_string(nw, PF_LT_LABEL, labels[i]);
1134 		i++;
1135 	}
1136 
1137 	snl_end_attr_nested(nw, off);
1138 }
1139 
1140 static void
snl_add_msg_attr_mape(struct snl_writer * nw,uint32_t type,const struct pf_mape_portset * me)1141 snl_add_msg_attr_mape(struct snl_writer *nw, uint32_t type, const struct pf_mape_portset *me)
1142 {
1143 	int off;
1144 
1145 	off = snl_add_msg_attr_nested(nw, type);
1146 
1147 	snl_add_msg_attr_u8(nw, PF_MET_OFFSET, me->offset);
1148 	snl_add_msg_attr_u8(nw, PF_MET_PSID_LEN, me->psidlen);
1149 	snl_add_msg_attr_u16(nw, PF_MET_PSID, me->psid);
1150 
1151 	snl_end_attr_nested(nw, off);
1152 }
1153 
1154 static void
snl_add_msg_attr_rpool(struct snl_writer * nw,uint32_t type,const struct pfctl_pool * pool)1155 snl_add_msg_attr_rpool(struct snl_writer *nw, uint32_t type, const struct pfctl_pool *pool)
1156 {
1157 	int off;
1158 
1159 	off = snl_add_msg_attr_nested(nw, type);
1160 
1161 	snl_add_msg_attr(nw, PF_PT_KEY, sizeof(pool->key), &pool->key);
1162 	snl_add_msg_attr_ip6(nw, PF_PT_COUNTER, &pool->counter.v6);
1163 	snl_add_msg_attr_u32(nw, PF_PT_TBLIDX, pool->tblidx);
1164 	snl_add_msg_attr_u16(nw, PF_PT_PROXY_SRC_PORT, pool->proxy_port[0]);
1165 	snl_add_msg_attr_u16(nw, PF_PT_PROXY_DST_PORT, pool->proxy_port[1]);
1166 	snl_add_msg_attr_u8(nw, PF_PT_OPTS, pool->opts);
1167 	snl_add_msg_attr_mape(nw, PF_PT_MAPE, &pool->mape);
1168 
1169 	snl_end_attr_nested(nw, off);
1170 }
1171 
1172 static void
snl_add_msg_attr_timeouts(struct snl_writer * nw,uint32_t type,const uint32_t * timeouts)1173 snl_add_msg_attr_timeouts(struct snl_writer *nw, uint32_t type, const uint32_t *timeouts)
1174 {
1175 	int off;
1176 
1177 	off = snl_add_msg_attr_nested(nw, type);
1178 
1179 	for (int i = 0; i < PFTM_MAX; i++)
1180 		snl_add_msg_attr_u32(nw, PF_TT_TIMEOUT, timeouts[i]);
1181 
1182 	snl_end_attr_nested(nw, off);
1183 }
1184 
1185 static void
snl_add_msg_attr_uid(struct snl_writer * nw,uint32_t type,const struct pf_rule_uid * uid)1186 snl_add_msg_attr_uid(struct snl_writer *nw, uint32_t type, const struct pf_rule_uid *uid)
1187 {
1188 	int off;
1189 
1190 	off = snl_add_msg_attr_nested(nw, type);
1191 
1192 	snl_add_msg_attr_u32(nw, PF_RUT_UID_LOW, uid->uid[0]);
1193 	snl_add_msg_attr_u32(nw, PF_RUT_UID_HIGH, uid->uid[1]);
1194 	snl_add_msg_attr_u8(nw, PF_RUT_OP, uid->op);
1195 
1196 	snl_end_attr_nested(nw, off);
1197 }
1198 
1199 static void
snl_add_msg_attr_pf_rule(struct snl_writer * nw,uint32_t type,const struct pfctl_rule * r)1200 snl_add_msg_attr_pf_rule(struct snl_writer *nw, uint32_t type, const struct pfctl_rule *r)
1201 {
1202 	int off;
1203 
1204 	off = snl_add_msg_attr_nested(nw, type);
1205 
1206 	snl_add_msg_attr_rule_addr(nw, PF_RT_SRC, &r->src);
1207 	snl_add_msg_attr_rule_addr(nw, PF_RT_DST, &r->dst);
1208 	snl_add_msg_attr_rule_labels(nw, PF_RT_LABELS, r->label);
1209 	snl_add_msg_attr_u32(nw, PF_RT_RIDENTIFIER, r->ridentifier);
1210 	snl_add_msg_attr_string(nw, PF_RT_IFNAME, r->ifname);
1211 	snl_add_msg_attr_string(nw, PF_RT_QNAME, r->qname);
1212 	snl_add_msg_attr_string(nw, PF_RT_PQNAME, r->pqname);
1213 	snl_add_msg_attr_string(nw, PF_RT_TAGNAME, r->tagname);
1214 	snl_add_msg_attr_string(nw, PF_RT_MATCH_TAGNAME, r->match_tagname);
1215 	snl_add_msg_attr_string(nw, PF_RT_OVERLOAD_TBLNAME, r->overload_tblname);
1216 	snl_add_msg_attr_rpool(nw, PF_RT_RPOOL, &r->rpool);
1217 	snl_add_msg_attr_u32(nw, PF_RT_OS_FINGERPRINT, r->os_fingerprint);
1218 	snl_add_msg_attr_u32(nw, PF_RT_RTABLEID, r->rtableid);
1219 	snl_add_msg_attr_timeouts(nw, PF_RT_TIMEOUT, r->timeout);
1220 	snl_add_msg_attr_u32(nw, PF_RT_MAX_STATES, r->max_states);
1221 	snl_add_msg_attr_u32(nw, PF_RT_MAX_SRC_NODES, r->max_src_nodes);
1222 	snl_add_msg_attr_u32(nw, PF_RT_MAX_SRC_STATES, r->max_src_states);
1223 	snl_add_msg_attr_u32(nw, PF_RT_MAX_SRC_CONN_RATE_LIMIT, r->max_src_conn_rate.limit);
1224 	snl_add_msg_attr_u32(nw, PF_RT_MAX_SRC_CONN_RATE_SECS, r->max_src_conn_rate.seconds);
1225 
1226 	snl_add_msg_attr_u16(nw, PF_RT_DNPIPE, r->dnpipe);
1227 	snl_add_msg_attr_u16(nw, PF_RT_DNRPIPE, r->dnrpipe);
1228 	snl_add_msg_attr_u32(nw, PF_RT_DNFLAGS, r->free_flags);
1229 
1230 	snl_add_msg_attr_u32(nw, PF_RT_NR, r->nr);
1231 	snl_add_msg_attr_u32(nw, PF_RT_PROB, r->prob);
1232 	snl_add_msg_attr_u32(nw, PF_RT_CUID, r->cuid);
1233 	snl_add_msg_attr_u32(nw, PF_RT_CPID, r->cpid);
1234 
1235 	snl_add_msg_attr_u16(nw, PF_RT_RETURN_ICMP, r->return_icmp);
1236 	snl_add_msg_attr_u16(nw, PF_RT_RETURN_ICMP6, r->return_icmp6);
1237 	snl_add_msg_attr_u16(nw, PF_RT_MAX_MSS, r->max_mss);
1238 	snl_add_msg_attr_u16(nw, PF_RT_SCRUB_FLAGS, r->scrub_flags);
1239 
1240 	snl_add_msg_attr_uid(nw, PF_RT_UID, &r->uid);
1241 	snl_add_msg_attr_uid(nw, PF_RT_GID, (const struct pf_rule_uid *)&r->gid);
1242 
1243 	snl_add_msg_attr_u32(nw, PF_RT_RULE_FLAG, r->rule_flag);
1244 	snl_add_msg_attr_u8(nw, PF_RT_ACTION, r->action);
1245 	snl_add_msg_attr_u8(nw, PF_RT_DIRECTION, r->direction);
1246 	snl_add_msg_attr_u8(nw, PF_RT_LOG, r->log);
1247 	snl_add_msg_attr_u8(nw, PF_RT_LOGIF, r->logif);
1248 	snl_add_msg_attr_u8(nw, PF_RT_QUICK, r->quick);
1249 	snl_add_msg_attr_u8(nw, PF_RT_IF_NOT, r->ifnot);
1250 	snl_add_msg_attr_u8(nw, PF_RT_MATCH_TAG_NOT, r->match_tag_not);
1251 	snl_add_msg_attr_u8(nw, PF_RT_NATPASS, r->natpass);
1252 	snl_add_msg_attr_u8(nw, PF_RT_KEEP_STATE, r->keep_state);
1253 	snl_add_msg_attr_u8(nw, PF_RT_AF, r->af);
1254 	snl_add_msg_attr_u8(nw, PF_RT_PROTO, r->proto);
1255 	snl_add_msg_attr_u8(nw, PF_RT_TYPE, r->type);
1256 	snl_add_msg_attr_u8(nw, PF_RT_CODE, r->code);
1257 	snl_add_msg_attr_u8(nw, PF_RT_FLAGS, r->flags);
1258 	snl_add_msg_attr_u8(nw, PF_RT_FLAGSET, r->flagset);
1259 	snl_add_msg_attr_u8(nw, PF_RT_MIN_TTL, r->min_ttl);
1260 	snl_add_msg_attr_u8(nw, PF_RT_ALLOW_OPTS, r->allow_opts);
1261 	snl_add_msg_attr_u8(nw, PF_RT_RT, r->rt);
1262 	snl_add_msg_attr_u8(nw, PF_RT_RETURN_TTL, r->return_ttl);
1263 	snl_add_msg_attr_u8(nw, PF_RT_TOS, r->tos);
1264 	snl_add_msg_attr_u8(nw, PF_RT_SET_TOS, r->set_tos);
1265 
1266 	snl_add_msg_attr_u8(nw, PF_RT_ANCHOR_RELATIVE, r->anchor_relative);
1267 	snl_add_msg_attr_u8(nw, PF_RT_ANCHOR_WILDCARD, r->anchor_wildcard);
1268 	snl_add_msg_attr_u8(nw, PF_RT_FLUSH, r->flush);
1269 	snl_add_msg_attr_u8(nw, PF_RT_PRIO, r->prio);
1270 	snl_add_msg_attr_u8(nw, PF_RT_SET_PRIO, r->set_prio[0]);
1271 	snl_add_msg_attr_u8(nw, PF_RT_SET_PRIO_REPLY, r->set_prio[1]);
1272 
1273 	snl_add_msg_attr_ip6(nw, PF_RT_DIVERT_ADDRESS, &r->divert.addr.v6);
1274 	snl_add_msg_attr_u16(nw, PF_RT_DIVERT_PORT, r->divert.port);
1275 
1276 	snl_end_attr_nested(nw, off);
1277 }
1278 
1279 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)1280 pfctl_add_rule(int dev __unused, const struct pfctl_rule *r, const char *anchor,
1281     const char *anchor_call, uint32_t ticket, uint32_t pool_ticket)
1282 {
1283 	struct pfctl_handle *h;
1284 	int ret;
1285 
1286 	h = pfctl_open(PF_DEVICE);
1287 	if (h == NULL)
1288 		return (ENODEV);
1289 
1290 	ret = pfctl_add_rule_h(h, r, anchor, anchor_call, ticket, pool_ticket);
1291 
1292 	pfctl_close(h);
1293 
1294 	return (ret);
1295 }
1296 
1297 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)1298 pfctl_add_rule_h(struct pfctl_handle *h, const struct pfctl_rule *r,
1299 	    const char *anchor, const char *anchor_call, uint32_t ticket,
1300 	    uint32_t pool_ticket)
1301 {
1302 	struct snl_writer nw;
1303 	struct snl_errmsg_data e = {};
1304 	struct nlmsghdr *hdr;
1305 	uint32_t seq_id;
1306 	int family_id;
1307 
1308 	family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
1309 	if (family_id == 0)
1310 		return (ENOTSUP);
1311 
1312 	snl_init_writer(&h->ss, &nw);
1313 	hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_ADDRULE);
1314 	hdr->nlmsg_flags |= NLM_F_DUMP;
1315 	snl_add_msg_attr_u32(&nw, PF_ART_TICKET, ticket);
1316 	snl_add_msg_attr_u32(&nw, PF_ART_POOL_TICKET, pool_ticket);
1317 	snl_add_msg_attr_string(&nw, PF_ART_ANCHOR, anchor);
1318 	snl_add_msg_attr_string(&nw, PF_ART_ANCHOR_CALL, anchor_call);
1319 
1320 	snl_add_msg_attr_pf_rule(&nw, PF_ART_RULE, r);
1321 
1322 	if ((hdr = snl_finalize_msg(&nw)) == NULL)
1323 		return (ENXIO);
1324 
1325 	seq_id = hdr->nlmsg_seq;
1326 
1327 	if (! snl_send_message(&h->ss, hdr))
1328 		return (ENXIO);
1329 
1330 	while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
1331 	}
1332 
1333 	return (e.error);
1334 }
1335 
1336 #define	_IN(_field)	offsetof(struct genlmsghdr, _field)
1337 #define	_OUT(_field)	offsetof(struct pfctl_rules_info, _field)
1338 static struct snl_attr_parser ap_getrules[] = {
1339 	{ .type = PF_GR_NR, .off = _OUT(nr), .cb = snl_attr_get_uint32 },
1340 	{ .type = PF_GR_TICKET, .off = _OUT(ticket), .cb = snl_attr_get_uint32 },
1341 };
1342 static struct snl_field_parser fp_getrules[] = {
1343 };
1344 #undef _IN
1345 #undef _OUT
1346 SNL_DECLARE_PARSER(getrules_parser, struct genlmsghdr, fp_getrules, ap_getrules);
1347 
1348 int
pfctl_get_rules_info_h(struct pfctl_handle * h,struct pfctl_rules_info * rules,uint32_t ruleset,const char * path)1349 pfctl_get_rules_info_h(struct pfctl_handle *h, struct pfctl_rules_info *rules, uint32_t ruleset,
1350     const char *path)
1351 {
1352 	struct snl_errmsg_data e = {};
1353 	struct nlmsghdr *hdr;
1354 	struct snl_writer nw;
1355 	uint32_t seq_id;
1356 	int family_id;
1357 
1358 	family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
1359 	if (family_id == 0)
1360 		return (ENOTSUP);
1361 
1362 	snl_init_writer(&h->ss, &nw);
1363 	hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_GETRULES);
1364 	hdr->nlmsg_flags |= NLM_F_DUMP;
1365 
1366 	snl_add_msg_attr_string(&nw, PF_GR_ANCHOR, path);
1367 	snl_add_msg_attr_u8(&nw, PF_GR_ACTION, ruleset);
1368 
1369 	hdr = snl_finalize_msg(&nw);
1370 	if (hdr == NULL)
1371 		return (ENOMEM);
1372 
1373 	seq_id = hdr->nlmsg_seq;
1374 	if (! snl_send_message(&h->ss, hdr))
1375 		return (ENXIO);
1376 
1377 	while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
1378 		if (! snl_parse_nlmsg(&h->ss, hdr, &getrules_parser, rules))
1379 			continue;
1380 	}
1381 
1382 	return (e.error);
1383 }
1384 
1385 int
pfctl_get_rules_info(int dev __unused,struct pfctl_rules_info * rules,uint32_t ruleset,const char * path)1386 pfctl_get_rules_info(int dev __unused, struct pfctl_rules_info *rules, uint32_t ruleset,
1387     const char *path)
1388 {
1389 	struct pfctl_handle *h;
1390 	int error;
1391 
1392 	h = pfctl_open(PF_DEVICE);
1393 	if (h == NULL)
1394 		return (ENOTSUP);
1395 	error = pfctl_get_rules_info_h(h, rules, ruleset, path);
1396 	pfctl_close(h);
1397 
1398 	return (error);
1399 }
1400 
1401 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)1402 pfctl_get_rule_h(struct pfctl_handle *h, uint32_t nr, uint32_t ticket, const char *anchor,
1403     uint32_t ruleset, struct pfctl_rule *rule, char *anchor_call)
1404 {
1405 	return (pfctl_get_clear_rule_h(h, nr, ticket, anchor, ruleset, rule,
1406 	    anchor_call, false));
1407 }
1408 
1409 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)1410 pfctl_get_rule(int dev, uint32_t nr, uint32_t ticket, const char *anchor,
1411     uint32_t ruleset, struct pfctl_rule *rule, char *anchor_call)
1412 {
1413 	return (pfctl_get_clear_rule(dev, nr, ticket, anchor, ruleset, rule,
1414 	    anchor_call, false));
1415 }
1416 
1417 #define _OUT(_field)	offsetof(struct pf_addr_wrap, _field)
1418 static const struct snl_attr_parser ap_addr_wrap[] = {
1419 	{ .type = PF_AT_ADDR, .off = _OUT(v.a.addr), .cb = snl_attr_get_in6_addr },
1420 	{ .type = PF_AT_MASK, .off = _OUT(v.a.mask), .cb = snl_attr_get_in6_addr },
1421 	{ .type = PF_AT_IFNAME, .off = _OUT(v.ifname), .arg = (void *)IFNAMSIZ,.cb = snl_attr_copy_string },
1422 	{ .type = PF_AT_TABLENAME, .off = _OUT(v.tblname), .arg = (void *)PF_TABLE_NAME_SIZE, .cb = snl_attr_copy_string },
1423 	{ .type = PF_AT_TYPE, .off = _OUT(type), .cb = snl_attr_get_uint8 },
1424 	{ .type = PF_AT_IFLAGS, .off = _OUT(iflags), .cb = snl_attr_get_uint8 },
1425 	{ .type = PF_AT_TBLCNT, .off = _OUT(p.tblcnt), .cb = snl_attr_get_uint32 },
1426 	{ .type = PF_AT_DYNCNT, .off = _OUT(p.dyncnt), .cb = snl_attr_get_uint32 },
1427 };
1428 SNL_DECLARE_ATTR_PARSER(addr_wrap_parser, ap_addr_wrap);
1429 #undef _OUT
1430 
1431 #define _OUT(_field)	offsetof(struct pf_rule_addr, _field)
1432 static struct snl_attr_parser ap_rule_addr[] = {
1433 	{ .type = PF_RAT_ADDR, .off = _OUT(addr), .arg = &addr_wrap_parser, .cb = snl_attr_get_nested },
1434 	{ .type = PF_RAT_SRC_PORT, .off = _OUT(port[0]), .cb = snl_attr_get_uint16 },
1435 	{ .type = PF_RAT_DST_PORT, .off = _OUT(port[1]), .cb = snl_attr_get_uint16 },
1436 	{ .type = PF_RAT_NEG, .off = _OUT(neg), .cb = snl_attr_get_uint8 },
1437 	{ .type = PF_RAT_OP, .off = _OUT(port_op), .cb = snl_attr_get_uint8 },
1438 };
1439 #undef _OUT
1440 SNL_DECLARE_ATTR_PARSER(rule_addr_parser, ap_rule_addr);
1441 
1442 struct snl_parsed_labels
1443 {
1444 	char		labels[PF_RULE_MAX_LABEL_COUNT][PF_RULE_LABEL_SIZE];
1445 	uint32_t	i;
1446 };
1447 
1448 static bool
snl_attr_get_pf_rule_labels(struct snl_state * ss,struct nlattr * nla,const void * arg __unused,void * target)1449 snl_attr_get_pf_rule_labels(struct snl_state *ss, struct nlattr *nla,
1450     const void *arg __unused, void *target)
1451 {
1452 	struct snl_parsed_labels *l = (struct snl_parsed_labels *)target;
1453 	bool ret;
1454 
1455 	if (l->i >= PF_RULE_MAX_LABEL_COUNT)
1456 		return (E2BIG);
1457 
1458 	ret = snl_attr_copy_string(ss, nla, (void *)PF_RULE_LABEL_SIZE,
1459 	    l->labels[l->i]);
1460 	if (ret)
1461 		l->i++;
1462 
1463 	return (ret);
1464 }
1465 
1466 #define _OUT(_field)	offsetof(struct nl_parsed_labels, _field)
1467 static const struct snl_attr_parser ap_labels[] = {
1468 	{ .type = PF_LT_LABEL, .off = 0, .cb = snl_attr_get_pf_rule_labels },
1469 };
1470 SNL_DECLARE_ATTR_PARSER(rule_labels_parser, ap_labels);
1471 #undef _OUT
1472 
1473 static bool
snl_attr_get_nested_pf_rule_labels(struct snl_state * ss,struct nlattr * nla,const void * arg __unused,void * target)1474 snl_attr_get_nested_pf_rule_labels(struct snl_state *ss, struct nlattr *nla,
1475     const void *arg __unused, void *target)
1476 {
1477 	struct snl_parsed_labels parsed_labels = { };
1478 	bool error;
1479 
1480 	/* Assumes target points to the beginning of the structure */
1481 	error = snl_parse_header(ss, NLA_DATA(nla), NLA_DATA_LEN(nla), &rule_labels_parser, &parsed_labels);
1482 	if (! error)
1483 		return (error);
1484 
1485 	memcpy(target, parsed_labels.labels, sizeof(parsed_labels.labels));
1486 
1487 	return (true);
1488 }
1489 
1490 #define _OUT(_field)	offsetof(struct pf_mape_portset, _field)
1491 static const struct snl_attr_parser ap_mape_portset[] = {
1492 	{ .type = PF_MET_OFFSET, .off = _OUT(offset), .cb = snl_attr_get_uint8 },
1493 	{ .type = PF_MET_PSID_LEN, .off = _OUT(psidlen), .cb = snl_attr_get_uint8 },
1494 	{. type = PF_MET_PSID, .off = _OUT(psid), .cb = snl_attr_get_uint16 },
1495 };
1496 SNL_DECLARE_ATTR_PARSER(mape_portset_parser, ap_mape_portset);
1497 #undef _OUT
1498 
1499 #define _OUT(_field)	offsetof(struct pfctl_pool, _field)
1500 static const struct snl_attr_parser ap_pool[] = {
1501 	{ .type = PF_PT_KEY, .off = _OUT(key), .arg = (void *)sizeof(struct pf_poolhashkey), .cb = snl_attr_get_bytes },
1502 	{ .type = PF_PT_COUNTER, .off = _OUT(counter), .cb = snl_attr_get_in6_addr },
1503 	{ .type = PF_PT_TBLIDX, .off = _OUT(tblidx), .cb = snl_attr_get_uint32 },
1504 	{ .type = PF_PT_PROXY_SRC_PORT, .off = _OUT(proxy_port[0]), .cb = snl_attr_get_uint16 },
1505 	{ .type = PF_PT_PROXY_DST_PORT, .off = _OUT(proxy_port[1]), .cb = snl_attr_get_uint16 },
1506 	{ .type = PF_PT_OPTS, .off = _OUT(opts), .cb = snl_attr_get_uint8 },
1507 	{ .type = PF_PT_MAPE, .off = _OUT(mape), .arg = &mape_portset_parser, .cb = snl_attr_get_nested },
1508 };
1509 SNL_DECLARE_ATTR_PARSER(pool_parser, ap_pool);
1510 #undef _OUT
1511 
1512 struct nl_parsed_timeouts
1513 {
1514 	uint32_t	timeouts[PFTM_MAX];
1515 	uint32_t	i;
1516 };
1517 
1518 static bool
snl_attr_get_pf_timeout(struct snl_state * ss,struct nlattr * nla,const void * arg __unused,void * target)1519 snl_attr_get_pf_timeout(struct snl_state *ss, struct nlattr *nla,
1520     const void *arg __unused, void *target)
1521 {
1522 	struct nl_parsed_timeouts *t = (struct nl_parsed_timeouts *)target;
1523 	bool ret;
1524 
1525 	if (t->i >= PFTM_MAX)
1526 		return (E2BIG);
1527 
1528 	ret = snl_attr_get_uint32(ss, nla, NULL, &t->timeouts[t->i]);
1529 	if (ret)
1530 		t->i++;
1531 
1532 	return (ret);
1533 }
1534 
1535 #define _OUT(_field)	offsetof(struct nl_parsed_timeout, _field)
1536 static const struct snl_attr_parser ap_timeouts[] = {
1537 	{ .type = PF_TT_TIMEOUT, .off = 0, .cb = snl_attr_get_pf_timeout },
1538 };
1539 SNL_DECLARE_ATTR_PARSER(timeout_parser, ap_timeouts);
1540 #undef _OUT
1541 
1542 static bool
snl_attr_get_nested_timeouts(struct snl_state * ss,struct nlattr * nla,const void * arg __unused,void * target)1543 snl_attr_get_nested_timeouts(struct snl_state *ss, struct nlattr *nla,
1544     const void *arg __unused, void *target)
1545 {
1546 	struct nl_parsed_timeouts parsed_timeouts = { };
1547 	bool error;
1548 
1549 	/* Assumes target points to the beginning of the structure */
1550 	error = snl_parse_header(ss, NLA_DATA(nla), NLA_DATA_LEN(nla), &timeout_parser, &parsed_timeouts);
1551 	if (! error)
1552 		return (error);
1553 
1554 	memcpy(target, parsed_timeouts.timeouts, sizeof(parsed_timeouts.timeouts));
1555 
1556 	return (true);
1557 }
1558 
1559 #define _OUT(_field)	offsetof(struct pf_rule_uid, _field)
1560 static const struct snl_attr_parser ap_rule_uid[] = {
1561 	{ .type = PF_RUT_UID_LOW, .off = _OUT(uid[0]), .cb = snl_attr_get_uint32 },
1562 	{ .type = PF_RUT_UID_HIGH, .off = _OUT(uid[1]), .cb = snl_attr_get_uint32 },
1563 	{ .type = PF_RUT_OP, .off = _OUT(op), .cb = snl_attr_get_uint8 },
1564 };
1565 SNL_DECLARE_ATTR_PARSER(rule_uid_parser, ap_rule_uid);
1566 #undef _OUT
1567 
1568 struct pfctl_nl_get_rule {
1569 	struct pfctl_rule r;
1570 	char anchor_call[MAXPATHLEN];
1571 };
1572 #define	_OUT(_field)	offsetof(struct pfctl_nl_get_rule, _field)
1573 static struct snl_attr_parser ap_getrule[] = {
1574 	{ .type = PF_RT_SRC, .off = _OUT(r.src), .arg = &rule_addr_parser,.cb = snl_attr_get_nested },
1575 	{ .type = PF_RT_DST, .off = _OUT(r.dst), .arg = &rule_addr_parser,.cb = snl_attr_get_nested },
1576 	{ .type = PF_RT_RIDENTIFIER, .off = _OUT(r.ridentifier), .cb = snl_attr_get_uint32 },
1577 	{ .type = PF_RT_LABELS, .off = _OUT(r.label), .arg = &rule_labels_parser,.cb = snl_attr_get_nested_pf_rule_labels },
1578 	{ .type = PF_RT_IFNAME, .off = _OUT(r.ifname), .arg = (void *)IFNAMSIZ, .cb = snl_attr_copy_string },
1579 	{ .type = PF_RT_QNAME, .off = _OUT(r.qname), .arg = (void *)PF_QNAME_SIZE, .cb = snl_attr_copy_string },
1580 	{ .type = PF_RT_PQNAME, .off = _OUT(r.pqname), .arg = (void *)PF_QNAME_SIZE, .cb = snl_attr_copy_string },
1581 	{ .type = PF_RT_TAGNAME, .off = _OUT(r.tagname), .arg = (void *)PF_TAG_NAME_SIZE, .cb = snl_attr_copy_string },
1582 	{ .type = PF_RT_MATCH_TAGNAME, .off = _OUT(r.match_tagname), .arg = (void *)PF_TAG_NAME_SIZE, .cb = snl_attr_copy_string },
1583 	{ .type = PF_RT_OVERLOAD_TBLNAME, .off = _OUT(r.overload_tblname), .arg = (void *)PF_TABLE_NAME_SIZE, .cb = snl_attr_copy_string },
1584 	{ .type = PF_RT_RPOOL, .off = _OUT(r.rpool), .arg = &pool_parser, .cb = snl_attr_get_nested },
1585 	{ .type = PF_RT_OS_FINGERPRINT, .off = _OUT(r.os_fingerprint), .cb = snl_attr_get_uint32 },
1586 	{ .type = PF_RT_RTABLEID, .off = _OUT(r.rtableid), .cb = snl_attr_get_uint32 },
1587 	{ .type = PF_RT_TIMEOUT, .off = _OUT(r.timeout), .arg = &timeout_parser, .cb = snl_attr_get_nested_timeouts },
1588 	{ .type = PF_RT_MAX_STATES, .off = _OUT(r.max_states), .cb = snl_attr_get_uint32 },
1589 	{ .type = PF_RT_MAX_SRC_NODES, .off = _OUT(r.max_src_nodes), .cb = snl_attr_get_uint32 },
1590 	{ .type = PF_RT_MAX_SRC_STATES, .off = _OUT(r.max_src_states), .cb = snl_attr_get_uint32 },
1591 	{ .type = PF_RT_MAX_SRC_CONN_RATE_LIMIT, .off = _OUT(r.max_src_conn_rate.limit), .cb = snl_attr_get_uint32 },
1592 	{ .type = PF_RT_MAX_SRC_CONN_RATE_SECS, .off = _OUT(r.max_src_conn_rate.seconds), .cb = snl_attr_get_uint32 },
1593 	{ .type = PF_RT_DNPIPE, .off = _OUT(r.dnpipe), .cb = snl_attr_get_uint16 },
1594 	{ .type = PF_RT_DNRPIPE, .off = _OUT(r.dnrpipe), .cb = snl_attr_get_uint16 },
1595 	{ .type = PF_RT_DNFLAGS, .off = _OUT(r.free_flags), .cb = snl_attr_get_uint32 },
1596 	{ .type = PF_RT_NR, .off = _OUT(r.nr), .cb = snl_attr_get_uint32 },
1597 	{ .type = PF_RT_PROB, .off = _OUT(r.prob), .cb = snl_attr_get_uint32 },
1598 	{ .type = PF_RT_CUID, .off = _OUT(r.cuid), .cb = snl_attr_get_uint32 },
1599 	{. type = PF_RT_CPID, .off = _OUT(r.cpid), .cb = snl_attr_get_uint32 },
1600 	{ .type = PF_RT_RETURN_ICMP, .off = _OUT(r.return_icmp), .cb = snl_attr_get_uint16 },
1601 	{ .type = PF_RT_RETURN_ICMP6, .off = _OUT(r.return_icmp6), .cb = snl_attr_get_uint16 },
1602 	{ .type = PF_RT_MAX_MSS, .off = _OUT(r.max_mss), .cb = snl_attr_get_uint16 },
1603 	{ .type = PF_RT_SCRUB_FLAGS, .off = _OUT(r.scrub_flags), .cb = snl_attr_get_uint16 },
1604 	{ .type = PF_RT_UID, .off = _OUT(r.uid), .arg = &rule_uid_parser, .cb = snl_attr_get_nested },
1605 	{ .type = PF_RT_GID, .off = _OUT(r.gid), .arg = &rule_uid_parser, .cb = snl_attr_get_nested },
1606 	{ .type = PF_RT_RULE_FLAG, .off = _OUT(r.rule_flag), .cb = snl_attr_get_uint32 },
1607 	{ .type = PF_RT_ACTION, .off = _OUT(r.action), .cb = snl_attr_get_uint8 },
1608 	{ .type = PF_RT_DIRECTION, .off = _OUT(r.direction), .cb = snl_attr_get_uint8 },
1609 	{ .type = PF_RT_LOG, .off = _OUT(r.log), .cb = snl_attr_get_uint8 },
1610 	{ .type = PF_RT_LOGIF, .off = _OUT(r.logif), .cb = snl_attr_get_uint8 },
1611 	{ .type = PF_RT_QUICK, .off = _OUT(r.quick), .cb = snl_attr_get_uint8 },
1612 	{ .type = PF_RT_IF_NOT, .off = _OUT(r.ifnot), .cb = snl_attr_get_uint8 },
1613 	{ .type = PF_RT_MATCH_TAG_NOT, .off = _OUT(r.match_tag_not), .cb = snl_attr_get_uint8 },
1614 	{ .type = PF_RT_NATPASS, .off = _OUT(r.natpass), .cb = snl_attr_get_uint8 },
1615 	{ .type = PF_RT_KEEP_STATE, .off = _OUT(r.keep_state), .cb = snl_attr_get_uint8 },
1616 	{ .type = PF_RT_AF, .off = _OUT(r.af), .cb = snl_attr_get_uint8 },
1617 	{ .type = PF_RT_PROTO, .off = _OUT(r.proto), .cb = snl_attr_get_uint8 },
1618 	{ .type = PF_RT_TYPE, .off = _OUT(r.type), .cb = snl_attr_get_uint8 },
1619 	{ .type = PF_RT_CODE, .off = _OUT(r.code), .cb = snl_attr_get_uint8 },
1620 	{ .type = PF_RT_FLAGS, .off = _OUT(r.flags), .cb = snl_attr_get_uint8 },
1621 	{ .type = PF_RT_FLAGSET, .off = _OUT(r.flagset), .cb = snl_attr_get_uint8 },
1622 	{ .type = PF_RT_MIN_TTL, .off = _OUT(r.min_ttl), .cb = snl_attr_get_uint8 },
1623 	{ .type = PF_RT_ALLOW_OPTS, .off = _OUT(r.allow_opts), .cb = snl_attr_get_uint8 },
1624 	{ .type = PF_RT_RT, .off = _OUT(r.rt), .cb = snl_attr_get_uint8 },
1625 	{ .type = PF_RT_RETURN_TTL, .off = _OUT(r.return_ttl), .cb = snl_attr_get_uint8 },
1626 	{ .type = PF_RT_TOS, .off = _OUT(r.tos), .cb = snl_attr_get_uint8 },
1627 	{ .type = PF_RT_SET_TOS, .off = _OUT(r.set_tos), .cb = snl_attr_get_uint8 },
1628 	{ .type = PF_RT_ANCHOR_RELATIVE, .off = _OUT(r.anchor_relative), .cb = snl_attr_get_uint8 },
1629 	{ .type = PF_RT_ANCHOR_WILDCARD, .off = _OUT(r.anchor_wildcard), .cb = snl_attr_get_uint8 },
1630 	{ .type = PF_RT_FLUSH, .off = _OUT(r.flush), .cb = snl_attr_get_uint8 },
1631 	{ .type = PF_RT_PRIO, .off = _OUT(r.prio), .cb = snl_attr_get_uint8 },
1632 	{ .type = PF_RT_SET_PRIO, .off = _OUT(r.set_prio[0]), .cb = snl_attr_get_uint8 },
1633 	{ .type = PF_RT_SET_PRIO_REPLY, .off = _OUT(r.set_prio[1]), .cb = snl_attr_get_uint8 },
1634 	{ .type = PF_RT_DIVERT_ADDRESS, .off = _OUT(r.divert.addr), .cb = snl_attr_get_in6_addr },
1635 	{ .type = PF_RT_DIVERT_PORT, .off = _OUT(r.divert.port), .cb = snl_attr_get_uint16 },
1636 	{ .type = PF_RT_PACKETS_IN, .off = _OUT(r.packets[0]), .cb = snl_attr_get_uint64 },
1637 	{ .type = PF_RT_PACKETS_OUT, .off = _OUT(r.packets[1]), .cb = snl_attr_get_uint64 },
1638 	{ .type = PF_RT_BYTES_IN, .off = _OUT(r.bytes[0]), .cb = snl_attr_get_uint64 },
1639 	{ .type = PF_RT_BYTES_OUT, .off = _OUT(r.bytes[1]), .cb = snl_attr_get_uint64 },
1640 	{ .type = PF_RT_EVALUATIONS, .off = _OUT(r.evaluations), .cb = snl_attr_get_uint64 },
1641 	{ .type = PF_RT_TIMESTAMP, .off = _OUT(r.last_active_timestamp), .cb = snl_attr_get_uint64 },
1642 	{ .type = PF_RT_STATES_CUR, .off = _OUT(r.states_cur), .cb = snl_attr_get_uint64 },
1643 	{ .type = PF_RT_STATES_TOTAL, .off = _OUT(r.states_tot), .cb = snl_attr_get_uint64 },
1644 	{ .type = PF_RT_SRC_NODES, .off = _OUT(r.src_nodes), .cb = snl_attr_get_uint64 },
1645 	{ .type = PF_RT_ANCHOR_CALL, .off = _OUT(anchor_call), .arg = (void*)MAXPATHLEN, .cb = snl_attr_copy_string },
1646 };
1647 static struct snl_field_parser fp_getrule[] = {};
1648 #undef _OUT
1649 SNL_DECLARE_PARSER(getrule_parser, struct genlmsghdr, fp_getrule, ap_getrule);
1650 
1651 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)1652 pfctl_get_clear_rule_h(struct pfctl_handle *h, uint32_t nr, uint32_t ticket,
1653     const char *anchor, uint32_t ruleset, struct pfctl_rule *rule,
1654     char *anchor_call, bool clear)
1655 {
1656 	struct pfctl_nl_get_rule attrs = {};
1657 	struct snl_errmsg_data e = {};
1658 	struct nlmsghdr *hdr;
1659 	struct snl_writer nw;
1660 	uint32_t seq_id;
1661 	int family_id;
1662 
1663 	family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
1664 	if (family_id == 0)
1665 		return (ENOTSUP);
1666 
1667 	snl_init_writer(&h->ss, &nw);
1668 	hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_GETRULE);
1669 	hdr->nlmsg_flags |= NLM_F_DUMP;
1670 
1671 	snl_add_msg_attr_string(&nw, PF_GR_ANCHOR, anchor);
1672 	snl_add_msg_attr_u8(&nw, PF_GR_ACTION, ruleset);
1673 	snl_add_msg_attr_u32(&nw, PF_GR_NR, nr);
1674 	snl_add_msg_attr_u32(&nw, PF_GR_TICKET, ticket);
1675 	snl_add_msg_attr_u8(&nw, PF_GR_CLEAR, clear);
1676 
1677 	hdr = snl_finalize_msg(&nw);
1678 	if (hdr == NULL)
1679 		return (ENOMEM);
1680 
1681 	seq_id = hdr->nlmsg_seq;
1682 	if (! snl_send_message(&h->ss, hdr))
1683 		return (ENXIO);
1684 
1685 	while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
1686 		if (! snl_parse_nlmsg(&h->ss, hdr, &getrule_parser, &attrs))
1687 			continue;
1688 	}
1689 
1690 	memcpy(rule, &attrs.r, sizeof(attrs.r));
1691 	strlcpy(anchor_call, attrs.anchor_call, MAXPATHLEN);
1692 
1693 	return (e.error);
1694 }
1695 
1696 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)1697 pfctl_get_clear_rule(int dev, uint32_t nr, uint32_t ticket,
1698 	    const char *anchor, uint32_t ruleset, struct pfctl_rule *rule,
1699 	    char *anchor_call, bool clear)
1700 {
1701 	nvlist_t *nvl;
1702 	int ret;
1703 
1704 	nvl = nvlist_create(0);
1705 	if (nvl == 0)
1706 		return (ENOMEM);
1707 
1708 	nvlist_add_number(nvl, "nr", nr);
1709 	nvlist_add_number(nvl, "ticket", ticket);
1710 	nvlist_add_string(nvl, "anchor", anchor);
1711 	nvlist_add_number(nvl, "ruleset", ruleset);
1712 
1713 	if (clear)
1714 		nvlist_add_bool(nvl, "clear_counter", true);
1715 
1716 	if ((ret = pfctl_do_ioctl(dev, DIOCGETRULENV, 8192, &nvl)) != 0)
1717 		goto out;
1718 
1719 	pf_nvrule_to_rule(nvlist_get_nvlist(nvl, "rule"), rule);
1720 
1721 	if (anchor_call)
1722 		strlcpy(anchor_call, nvlist_get_string(nvl, "anchor_call"),
1723 		    MAXPATHLEN);
1724 
1725 out:
1726 	nvlist_destroy(nvl);
1727 	return (ret);
1728 }
1729 
1730 int
pfctl_set_keepcounters(int dev,bool keep)1731 pfctl_set_keepcounters(int dev, bool keep)
1732 {
1733 	struct pfioc_nv	 nv;
1734 	nvlist_t	*nvl;
1735 	int		 ret;
1736 
1737 	nvl = nvlist_create(0);
1738 
1739 	nvlist_add_bool(nvl, "keep_counters", keep);
1740 
1741 	nv.data = nvlist_pack(nvl, &nv.len);
1742 	nv.size = nv.len;
1743 
1744 	nvlist_destroy(nvl);
1745 
1746 	ret = ioctl(dev, DIOCKEEPCOUNTERS, &nv);
1747 
1748 	free(nv.data);
1749 	return (ret);
1750 }
1751 
1752 struct pfctl_creator {
1753 	uint32_t id;
1754 };
1755 #define	_IN(_field)	offsetof(struct genlmsghdr, _field)
1756 #define	_OUT(_field)	offsetof(struct pfctl_creator, _field)
1757 static struct snl_attr_parser ap_creators[] = {
1758 	{ .type = PF_ST_CREATORID, .off = _OUT(id), .cb = snl_attr_get_uint32 },
1759 };
1760 static struct snl_field_parser fp_creators[] = {
1761 };
1762 #undef _IN
1763 #undef _OUT
1764 SNL_DECLARE_PARSER(creator_parser, struct genlmsghdr, fp_creators, ap_creators);
1765 
1766 static int
pfctl_get_creators_nl(struct snl_state * ss,uint32_t * creators,size_t * len)1767 pfctl_get_creators_nl(struct snl_state *ss, uint32_t *creators, size_t *len)
1768 {
1769 
1770 	int family_id = snl_get_genl_family(ss, PFNL_FAMILY_NAME);
1771 	size_t i = 0;
1772 
1773 	struct nlmsghdr *hdr;
1774 	struct snl_writer nw;
1775 
1776 	if (family_id == 0)
1777 		return (ENOTSUP);
1778 
1779 	snl_init_writer(ss, &nw);
1780 	hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_GETCREATORS);
1781 	hdr->nlmsg_flags |= NLM_F_DUMP;
1782 	hdr = snl_finalize_msg(&nw);
1783 	if (hdr == NULL)
1784 		return (ENOMEM);
1785 	uint32_t seq_id = hdr->nlmsg_seq;
1786 
1787 	snl_send_message(ss, hdr);
1788 
1789 	struct snl_errmsg_data e = {};
1790 	while ((hdr = snl_read_reply_multi(ss, seq_id, &e)) != NULL) {
1791 		struct pfctl_creator c;
1792 		bzero(&c, sizeof(c));
1793 
1794 		if (!snl_parse_nlmsg(ss, hdr, &creator_parser, &c))
1795 			continue;
1796 
1797 		creators[i] = c.id;
1798 		i++;
1799 		if (i > *len)
1800 			return (E2BIG);
1801 	}
1802 
1803 	*len = i;
1804 
1805 	return (0);
1806 }
1807 
1808 int
pfctl_get_creatorids(struct pfctl_handle * h,uint32_t * creators,size_t * len)1809 pfctl_get_creatorids(struct pfctl_handle *h, uint32_t *creators, size_t *len)
1810 {
1811 	int error;
1812 
1813 	error = pfctl_get_creators_nl(&h->ss, creators, len);
1814 
1815 	return (error);
1816 }
1817 
1818 static inline bool
snl_attr_get_pfaddr(struct snl_state * ss __unused,struct nlattr * nla,const void * arg __unused,void * target)1819 snl_attr_get_pfaddr(struct snl_state *ss __unused, struct nlattr *nla,
1820     const void *arg __unused, void *target)
1821 {
1822 	memcpy(target, NLA_DATA(nla), NLA_DATA_LEN(nla));
1823 	return (true);
1824 }
1825 
1826 static inline bool
snl_attr_store_ifname(struct snl_state * ss __unused,struct nlattr * nla,const void * arg __unused,void * target)1827 snl_attr_store_ifname(struct snl_state *ss __unused, struct nlattr *nla,
1828     const void *arg __unused, void *target)
1829 {
1830 	size_t maxlen = NLA_DATA_LEN(nla);
1831 
1832 	if (strnlen((char *)NLA_DATA(nla), maxlen) < maxlen) {
1833 		strlcpy(target, (char *)NLA_DATA(nla), maxlen);
1834 		return (true);
1835 	}
1836 	return (false);
1837 }
1838 
1839 #define	_OUT(_field)	offsetof(struct pfctl_state_peer, _field)
1840 static const struct snl_attr_parser nla_p_speer[] = {
1841 	{ .type = PF_STP_SEQLO, .off = _OUT(seqlo), .cb = snl_attr_get_uint32 },
1842 	{ .type = PF_STP_SEQHI, .off = _OUT(seqhi), .cb = snl_attr_get_uint32 },
1843 	{ .type = PF_STP_SEQDIFF, .off = _OUT(seqdiff), .cb = snl_attr_get_uint32 },
1844 	{ .type = PF_STP_STATE, .off = _OUT(state), .cb = snl_attr_get_uint8 },
1845 	{ .type = PF_STP_WSCALE, .off = _OUT(wscale), .cb = snl_attr_get_uint8 },
1846 };
1847 SNL_DECLARE_ATTR_PARSER(speer_parser, nla_p_speer);
1848 #undef _OUT
1849 
1850 #define	_OUT(_field)	offsetof(struct pf_state_key_export, _field)
1851 static const struct snl_attr_parser nla_p_skey[] = {
1852 	{ .type = PF_STK_ADDR0, .off = _OUT(addr[0]), .cb = snl_attr_get_pfaddr },
1853 	{ .type = PF_STK_ADDR1, .off = _OUT(addr[1]), .cb = snl_attr_get_pfaddr },
1854 	{ .type = PF_STK_PORT0, .off = _OUT(port[0]), .cb = snl_attr_get_uint16 },
1855 	{ .type = PF_STK_PORT1, .off = _OUT(port[1]), .cb = snl_attr_get_uint16 },
1856 };
1857 SNL_DECLARE_ATTR_PARSER(skey_parser, nla_p_skey);
1858 #undef _OUT
1859 
1860 #define	_IN(_field)	offsetof(struct genlmsghdr, _field)
1861 #define	_OUT(_field)	offsetof(struct pfctl_state, _field)
1862 static struct snl_attr_parser ap_state[] = {
1863 	{ .type = PF_ST_ID, .off = _OUT(id), .cb = snl_attr_get_uint64 },
1864 	{ .type = PF_ST_CREATORID, .off = _OUT(creatorid), .cb = snl_attr_get_uint32 },
1865 	{ .type = PF_ST_IFNAME, .off = _OUT(ifname), .cb = snl_attr_store_ifname },
1866 	{ .type = PF_ST_ORIG_IFNAME, .off = _OUT(orig_ifname), .cb = snl_attr_store_ifname },
1867 	{ .type = PF_ST_KEY_WIRE, .off = _OUT(key[0]), .arg = &skey_parser, .cb = snl_attr_get_nested },
1868 	{ .type = PF_ST_KEY_STACK, .off = _OUT(key[1]), .arg = &skey_parser, .cb = snl_attr_get_nested },
1869 	{ .type = PF_ST_PEER_SRC, .off = _OUT(src), .arg = &speer_parser, .cb = snl_attr_get_nested },
1870 	{ .type = PF_ST_PEER_DST, .off = _OUT(dst), .arg = &speer_parser, .cb = snl_attr_get_nested },
1871 	{ .type = PF_ST_RT_ADDR, .off = _OUT(rt_addr), .cb = snl_attr_get_pfaddr },
1872 	{ .type = PF_ST_RULE, .off = _OUT(rule), .cb = snl_attr_get_uint32 },
1873 	{ .type = PF_ST_ANCHOR, .off = _OUT(anchor), .cb = snl_attr_get_uint32 },
1874 	{ .type = PF_ST_NAT_RULE, .off = _OUT(nat_rule), .cb = snl_attr_get_uint32 },
1875 	{ .type = PF_ST_CREATION, .off = _OUT(creation), .cb = snl_attr_get_uint32 },
1876 	{ .type = PF_ST_EXPIRE, .off = _OUT(expire), .cb = snl_attr_get_uint32 },
1877 	{ .type = PF_ST_PACKETS0, .off = _OUT(packets[0]), .cb = snl_attr_get_uint64 },
1878 	{ .type = PF_ST_PACKETS1, .off = _OUT(packets[1]), .cb = snl_attr_get_uint64 },
1879 	{ .type = PF_ST_BYTES0, .off = _OUT(bytes[0]), .cb = snl_attr_get_uint64 },
1880 	{ .type = PF_ST_BYTES1, .off = _OUT(bytes[1]), .cb = snl_attr_get_uint64 },
1881 	{ .type = PF_ST_AF, .off = _OUT(key[0].af), .cb = snl_attr_get_uint8 },
1882 	{ .type = PF_ST_PROTO, .off = _OUT(key[0].proto), .cb = snl_attr_get_uint8 },
1883 	{ .type = PF_ST_DIRECTION, .off = _OUT(direction), .cb = snl_attr_get_uint8 },
1884 	{ .type = PF_ST_LOG, .off = _OUT(log), .cb = snl_attr_get_uint8 },
1885 	{ .type = PF_ST_STATE_FLAGS, .off = _OUT(state_flags), .cb = snl_attr_get_uint16 },
1886 	{ .type = PF_ST_SYNC_FLAGS, .off = _OUT(sync_flags), .cb = snl_attr_get_uint8 },
1887 	{ .type = PF_ST_RTABLEID, .off = _OUT(rtableid), .cb = snl_attr_get_int32 },
1888 	{ .type = PF_ST_MIN_TTL, .off = _OUT(min_ttl), .cb = snl_attr_get_uint8 },
1889 	{ .type = PF_ST_MAX_MSS, .off = _OUT(max_mss), .cb = snl_attr_get_uint16 },
1890 	{ .type = PF_ST_DNPIPE, .off = _OUT(dnpipe), .cb = snl_attr_get_uint16 },
1891 	{ .type = PF_ST_DNRPIPE, .off = _OUT(dnrpipe), .cb = snl_attr_get_uint16 },
1892 	{ .type = PF_ST_RT, .off = _OUT(rt), .cb = snl_attr_get_uint8 },
1893 	{ .type = PF_ST_RT_IFNAME, .off = _OUT(rt_ifname), .cb = snl_attr_store_ifname },
1894 };
1895 static struct snl_field_parser fp_state[] = {
1896 };
1897 #undef _IN
1898 #undef _OUT
1899 SNL_DECLARE_PARSER(state_parser, struct genlmsghdr, fp_state, ap_state);
1900 
1901 static const struct snl_hdr_parser *all_parsers[] = {
1902 	&state_parser, &skey_parser, &speer_parser,
1903 	&creator_parser, &getrules_parser
1904 };
1905 
1906 static int
pfctl_get_states_nl(struct pfctl_state_filter * filter,struct snl_state * ss,pfctl_get_state_fn f,void * arg)1907 pfctl_get_states_nl(struct pfctl_state_filter *filter, struct snl_state *ss, pfctl_get_state_fn f, void *arg)
1908 {
1909 	SNL_VERIFY_PARSERS(all_parsers);
1910 	int family_id = snl_get_genl_family(ss, PFNL_FAMILY_NAME);
1911 	int ret;
1912 
1913 	struct nlmsghdr *hdr;
1914 	struct snl_writer nw;
1915 
1916 	if (family_id == 0)
1917 		return (ENOTSUP);
1918 
1919 	snl_init_writer(ss, &nw);
1920 	hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_GETSTATES);
1921 	hdr->nlmsg_flags |= NLM_F_DUMP;
1922 	snl_add_msg_attr_string(&nw, PF_ST_IFNAME, filter->ifname);
1923 	snl_add_msg_attr_u16(&nw, PF_ST_PROTO, filter->proto);
1924 	snl_add_msg_attr_u8(&nw, PF_ST_AF, filter->af);
1925 	snl_add_msg_attr_ip6(&nw, PF_ST_FILTER_ADDR, &filter->addr.v6);
1926 	snl_add_msg_attr_ip6(&nw, PF_ST_FILTER_MASK, &filter->mask.v6);
1927 
1928 	hdr = snl_finalize_msg(&nw);
1929 	if (hdr == NULL)
1930 		return (ENOMEM);
1931 
1932 	uint32_t seq_id = hdr->nlmsg_seq;
1933 
1934 	snl_send_message(ss, hdr);
1935 
1936 	struct snl_errmsg_data e = {};
1937 	while ((hdr = snl_read_reply_multi(ss, seq_id, &e)) != NULL) {
1938 		struct pfctl_state s;
1939 		bzero(&s, sizeof(s));
1940 		if (!snl_parse_nlmsg(ss, hdr, &state_parser, &s))
1941 			continue;
1942 
1943 		s.key[1].af = s.key[0].af;
1944 		s.key[1].proto = s.key[0].proto;
1945 
1946 		ret = f(&s, arg);
1947 		if (ret != 0)
1948 			return (ret);
1949 	}
1950 
1951 	return (0);
1952 }
1953 
1954 int
pfctl_get_states_iter(pfctl_get_state_fn f,void * arg)1955 pfctl_get_states_iter(pfctl_get_state_fn f, void *arg)
1956 {
1957 	struct pfctl_state_filter filter = {};
1958 	return (pfctl_get_filtered_states_iter(&filter, f, arg));
1959 }
1960 
1961 int
pfctl_get_filtered_states_iter(struct pfctl_state_filter * filter,pfctl_get_state_fn f,void * arg)1962 pfctl_get_filtered_states_iter(struct pfctl_state_filter *filter, pfctl_get_state_fn f, void *arg)
1963 {
1964 	struct snl_state ss = {};
1965 	int error;
1966 
1967 	snl_init(&ss, NETLINK_GENERIC);
1968 	error = pfctl_get_states_nl(filter, &ss, f, arg);
1969 	snl_free(&ss);
1970 
1971 	return (error);
1972 }
1973 
1974 static int
pfctl_append_states(struct pfctl_state * s,void * arg)1975 pfctl_append_states(struct pfctl_state *s, void *arg)
1976 {
1977 	struct pfctl_state *new;
1978 	struct pfctl_states *states = (struct pfctl_states *)arg;
1979 
1980 	new = malloc(sizeof(*s));
1981 	if (new == NULL)
1982 		return (ENOMEM);
1983 
1984 	memcpy(new, s, sizeof(*s));
1985 
1986 	TAILQ_INSERT_TAIL(&states->states, new, entry);
1987 
1988 	return (0);
1989 }
1990 
1991 int
pfctl_get_states(int dev __unused,struct pfctl_states * states)1992 pfctl_get_states(int dev __unused, struct pfctl_states *states)
1993 {
1994 	int ret;
1995 
1996 	bzero(states, sizeof(*states));
1997 	TAILQ_INIT(&states->states);
1998 
1999 	ret = pfctl_get_states_iter(pfctl_append_states, states);
2000 	if (ret != 0) {
2001 		pfctl_free_states(states);
2002 		return (ret);
2003 	}
2004 
2005 	return (0);
2006 }
2007 
2008 void
pfctl_free_states(struct pfctl_states * states)2009 pfctl_free_states(struct pfctl_states *states)
2010 {
2011 	struct pfctl_state *s, *tmp;
2012 
2013 	TAILQ_FOREACH_SAFE(s, &states->states, entry, tmp) {
2014 		free(s);
2015 	}
2016 
2017 	bzero(states, sizeof(*states));
2018 }
2019 
2020 struct pfctl_nl_clear_states {
2021 	uint32_t killed;
2022 };
2023 #define	_OUT(_field)	offsetof(struct pfctl_nl_clear_states, _field)
2024 static struct snl_attr_parser ap_clear_states[] = {
2025 	{ .type = PF_CS_KILLED, .off = _OUT(killed), .cb = snl_attr_get_uint32 },
2026 };
2027 static struct snl_field_parser fp_clear_states[] = {};
2028 #undef _OUT
2029 SNL_DECLARE_PARSER(clear_states_parser, struct genlmsghdr, fp_clear_states, ap_clear_states);
2030 
2031 static int
_pfctl_clear_states_h(struct pfctl_handle * h,const struct pfctl_kill * kill,unsigned int * killed,int cmd)2032 _pfctl_clear_states_h(struct pfctl_handle *h, const struct pfctl_kill *kill,
2033     unsigned int *killed, int cmd)
2034 {
2035 	struct snl_writer nw;
2036 	struct snl_errmsg_data e = {};
2037 	struct pfctl_nl_clear_states attrs = {};
2038 	struct nlmsghdr *hdr;
2039 	uint32_t seq_id;
2040 	int family_id;
2041 
2042 	family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
2043 	if (family_id == 0)
2044 		return (ENOTSUP);
2045 
2046 	snl_init_writer(&h->ss, &nw);
2047 	hdr = snl_create_genl_msg_request(&nw, family_id, cmd);
2048 	hdr->nlmsg_flags |= NLM_F_DUMP;
2049 
2050 	snl_add_msg_attr_u64(&nw, PF_CS_CMP_ID, kill->cmp.id);
2051 	snl_add_msg_attr_u32(&nw, PF_CS_CMP_CREATORID, htonl(kill->cmp.creatorid));
2052 	snl_add_msg_attr_u8(&nw, PF_CS_CMP_DIR, kill->cmp.direction);
2053 	snl_add_msg_attr_u8(&nw, PF_CS_AF, kill->af);
2054 	snl_add_msg_attr_u8(&nw, PF_CS_PROTO, kill->proto);
2055 	snl_add_msg_attr_rule_addr(&nw, PF_CS_SRC, &kill->src);
2056 	snl_add_msg_attr_rule_addr(&nw, PF_CS_DST, &kill->dst);
2057 	snl_add_msg_attr_rule_addr(&nw, PF_CS_RT_ADDR, &kill->rt_addr);
2058 	snl_add_msg_attr_string(&nw, PF_CS_IFNAME, kill->ifname);
2059 	snl_add_msg_attr_string(&nw, PF_CS_LABEL, kill->label);
2060 	snl_add_msg_attr_bool(&nw, PF_CS_KILL_MATCH, kill->kill_match);
2061 	snl_add_msg_attr_bool(&nw, PF_CS_NAT, kill->nat);
2062 
2063 	if ((hdr = snl_finalize_msg(&nw)) == NULL)
2064 		return (ENXIO);
2065 
2066 	seq_id = hdr->nlmsg_seq;
2067 
2068 	if (! snl_send_message(&h->ss, hdr))
2069 		return (ENXIO);
2070 
2071 	while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
2072 		if (! snl_parse_nlmsg(&h->ss, hdr, &clear_states_parser, &attrs))
2073 			continue;
2074 	}
2075 
2076 	if (killed)
2077 		*killed = attrs.killed;
2078 
2079 	return (e.error);
2080 }
2081 
2082 int
pfctl_clear_states_h(struct pfctl_handle * h,const struct pfctl_kill * kill,unsigned int * killed)2083 pfctl_clear_states_h(struct pfctl_handle *h, const struct pfctl_kill *kill,
2084     unsigned int *killed)
2085 {
2086 	return(_pfctl_clear_states_h(h, kill, killed, PFNL_CMD_CLRSTATES));
2087 }
2088 
2089 int
pfctl_kill_states_h(struct pfctl_handle * h,const struct pfctl_kill * kill,unsigned int * killed)2090 pfctl_kill_states_h(struct pfctl_handle *h, const struct pfctl_kill *kill,
2091     unsigned int *killed)
2092 {
2093 	return(_pfctl_clear_states_h(h, kill, killed, PFNL_CMD_KILLSTATES));
2094 }
2095 
2096 static int
_pfctl_clear_states(int dev __unused,const struct pfctl_kill * kill,unsigned int * killed,uint64_t cmd)2097 _pfctl_clear_states(int dev __unused, const struct pfctl_kill *kill,
2098     unsigned int *killed, uint64_t cmd)
2099 {
2100 	struct pfctl_handle *h;
2101 	int ret;
2102 
2103 	h = pfctl_open(PF_DEVICE);
2104 	if (h == NULL)
2105 		return (ENODEV);
2106 
2107 	ret = _pfctl_clear_states_h(h, kill, killed, cmd);
2108 	pfctl_close(h);
2109 
2110 	return (ret);
2111 }
2112 
2113 int
pfctl_clear_states(int dev __unused,const struct pfctl_kill * kill,unsigned int * killed)2114 pfctl_clear_states(int dev __unused, const struct pfctl_kill *kill,
2115     unsigned int *killed)
2116 {
2117 	return (_pfctl_clear_states(dev, kill, killed, PFNL_CMD_CLRSTATES));
2118 }
2119 
2120 int
pfctl_kill_states(int dev __unused,const struct pfctl_kill * kill,unsigned int * killed)2121 pfctl_kill_states(int dev __unused, const struct pfctl_kill *kill, unsigned int *killed)
2122 {
2123 	return (_pfctl_clear_states(dev, kill, killed, PFNL_CMD_KILLSTATES));
2124 }
2125 
2126 int
pfctl_clear_rules(int dev,const char * anchorname)2127 pfctl_clear_rules(int dev, const char *anchorname)
2128 {
2129 	struct pfioc_trans trans;
2130 	struct pfioc_trans_e transe[2];
2131 	int ret;
2132 
2133 	bzero(&trans, sizeof(trans));
2134 	bzero(&transe, sizeof(transe));
2135 
2136 	transe[0].rs_num = PF_RULESET_SCRUB;
2137 	if (strlcpy(transe[0].anchor, anchorname, sizeof(transe[0].anchor))
2138 	    >= sizeof(transe[0].anchor))
2139 		return (E2BIG);
2140 
2141 	transe[1].rs_num = PF_RULESET_FILTER;
2142 	if (strlcpy(transe[1].anchor, anchorname, sizeof(transe[1].anchor))
2143 	    >= sizeof(transe[1].anchor))
2144 		return (E2BIG);
2145 
2146 	trans.size = 2;
2147 	trans.esize = sizeof(transe[0]);
2148 	trans.array = transe;
2149 
2150 	ret = ioctl(dev, DIOCXBEGIN, &trans);
2151 	if (ret != 0)
2152 		return (ret);
2153 	return ioctl(dev, DIOCXCOMMIT, &trans);
2154 }
2155 
2156 int
pfctl_clear_nat(int dev,const char * anchorname)2157 pfctl_clear_nat(int dev, const char *anchorname)
2158 {
2159 	struct pfioc_trans trans;
2160 	struct pfioc_trans_e transe[3];
2161 	int ret;
2162 
2163 	bzero(&trans, sizeof(trans));
2164 	bzero(&transe, sizeof(transe));
2165 
2166 	transe[0].rs_num = PF_RULESET_NAT;
2167 	if (strlcpy(transe[0].anchor, anchorname, sizeof(transe[0].anchor))
2168 	    >= sizeof(transe[0].anchor))
2169 		return (E2BIG);
2170 
2171 	transe[1].rs_num = PF_RULESET_BINAT;
2172 	if (strlcpy(transe[1].anchor, anchorname, sizeof(transe[1].anchor))
2173 	    >= sizeof(transe[0].anchor))
2174 		return (E2BIG);
2175 
2176 	transe[2].rs_num = PF_RULESET_RDR;
2177 	if (strlcpy(transe[2].anchor, anchorname, sizeof(transe[2].anchor))
2178 	    >= sizeof(transe[2].anchor))
2179 		return (E2BIG);
2180 
2181 	trans.size = 3;
2182 	trans.esize = sizeof(transe[0]);
2183 	trans.array = transe;
2184 
2185 	ret = ioctl(dev, DIOCXBEGIN, &trans);
2186 	if (ret != 0)
2187 		return (ret);
2188 	return ioctl(dev, DIOCXCOMMIT, &trans);
2189 }
2190 int
pfctl_clear_eth_rules(int dev,const char * anchorname)2191 pfctl_clear_eth_rules(int dev, const char *anchorname)
2192 {
2193 	struct pfioc_trans trans;
2194 	struct pfioc_trans_e transe;
2195 	int ret;
2196 
2197 	bzero(&trans, sizeof(trans));
2198 	bzero(&transe, sizeof(transe));
2199 
2200 	transe.rs_num = PF_RULESET_ETH;
2201 	if (strlcpy(transe.anchor, anchorname, sizeof(transe.anchor))
2202 	    >= sizeof(transe.anchor))
2203 		return (E2BIG);
2204 
2205 	trans.size = 1;
2206 	trans.esize = sizeof(transe);
2207 	trans.array = &transe;
2208 
2209 	ret = ioctl(dev, DIOCXBEGIN, &trans);
2210 	if (ret != 0)
2211 		return (ret);
2212 	return ioctl(dev, DIOCXCOMMIT, &trans);
2213 }
2214 
2215 static int
_pfctl_get_limit(int dev,const int index,uint * limit)2216 _pfctl_get_limit(int dev, const int index, uint *limit)
2217 {
2218 	struct pfioc_limit pl;
2219 
2220 	bzero(&pl, sizeof(pl));
2221 	pl.index = index;
2222 
2223 	if (ioctl(dev, DIOCGETLIMIT, &pl) == -1)
2224 		return (errno);
2225 
2226 	*limit = pl.limit;
2227 
2228 	return (0);
2229 }
2230 
2231 int
pfctl_set_syncookies(int dev,const struct pfctl_syncookies * s)2232 pfctl_set_syncookies(int dev, const struct pfctl_syncookies *s)
2233 {
2234 	struct pfioc_nv	 nv;
2235 	nvlist_t	*nvl;
2236 	int		 ret;
2237 	uint		 state_limit;
2238 	uint64_t	 lim, hi, lo;
2239 
2240 	ret = _pfctl_get_limit(dev, PF_LIMIT_STATES, &state_limit);
2241 	if (ret != 0)
2242 		return (ret);
2243 
2244 	lim = state_limit;
2245 	hi = lim * s->highwater / 100;
2246 	lo = lim * s->lowwater / 100;
2247 
2248 	if (lo == hi)
2249 		hi++;
2250 
2251 	nvl = nvlist_create(0);
2252 
2253 	nvlist_add_bool(nvl, "enabled", s->mode != PFCTL_SYNCOOKIES_NEVER);
2254 	nvlist_add_bool(nvl, "adaptive", s->mode == PFCTL_SYNCOOKIES_ADAPTIVE);
2255 	nvlist_add_number(nvl, "highwater", hi);
2256 	nvlist_add_number(nvl, "lowwater", lo);
2257 
2258 	nv.data = nvlist_pack(nvl, &nv.len);
2259 	nv.size = nv.len;
2260 	nvlist_destroy(nvl);
2261 	nvl = NULL;
2262 
2263 	ret = ioctl(dev, DIOCSETSYNCOOKIES, &nv);
2264 
2265 	free(nv.data);
2266 	return (ret);
2267 }
2268 
2269 int
pfctl_get_syncookies(int dev,struct pfctl_syncookies * s)2270 pfctl_get_syncookies(int dev, struct pfctl_syncookies *s)
2271 {
2272 	nvlist_t	*nvl;
2273 	int		 ret;
2274 	uint		 state_limit;
2275 	bool		 enabled, adaptive;
2276 
2277 	ret = _pfctl_get_limit(dev, PF_LIMIT_STATES, &state_limit);
2278 	if (ret != 0)
2279 		return (ret);
2280 
2281 	bzero(s, sizeof(*s));
2282 
2283 	nvl = nvlist_create(0);
2284 
2285 	if ((ret = pfctl_do_ioctl(dev, DIOCGETSYNCOOKIES, 256, &nvl)) != 0) {
2286 		ret = errno;
2287 		goto out;
2288 	}
2289 
2290 	enabled = nvlist_get_bool(nvl, "enabled");
2291 	adaptive = nvlist_get_bool(nvl, "adaptive");
2292 
2293 	if (enabled) {
2294 		if (adaptive)
2295 			s->mode = PFCTL_SYNCOOKIES_ADAPTIVE;
2296 		else
2297 			s->mode = PFCTL_SYNCOOKIES_ALWAYS;
2298 	} else {
2299 		s->mode = PFCTL_SYNCOOKIES_NEVER;
2300 	}
2301 
2302 	s->highwater = nvlist_get_number(nvl, "highwater") * 100 / state_limit;
2303 	s->lowwater = nvlist_get_number(nvl, "lowwater") * 100 / state_limit;
2304 	s->halfopen_states = nvlist_get_number(nvl, "halfopen_states");
2305 
2306 out:
2307 	nvlist_destroy(nvl);
2308 	return (ret);
2309 }
2310 
2311 int
pfctl_table_add_addrs(int dev,struct pfr_table * tbl,struct pfr_addr * addr,int size,int * nadd,int flags)2312 pfctl_table_add_addrs(int dev, struct pfr_table *tbl, struct pfr_addr
2313     *addr, int size, int *nadd, int flags)
2314 {
2315 	struct pfioc_table io;
2316 
2317 	if (tbl == NULL || size < 0 || (size && addr == NULL)) {
2318 		return (EINVAL);
2319 	}
2320 	bzero(&io, sizeof io);
2321 	io.pfrio_flags = flags;
2322 	io.pfrio_table = *tbl;
2323 	io.pfrio_buffer = addr;
2324 	io.pfrio_esize = sizeof(*addr);
2325 	io.pfrio_size = size;
2326 
2327 	if (ioctl(dev, DIOCRADDADDRS, &io))
2328 		return (errno);
2329 	if (nadd != NULL)
2330 		*nadd = io.pfrio_nadd;
2331 	return (0);
2332 }
2333 
2334 int
pfctl_table_del_addrs(int dev,struct pfr_table * tbl,struct pfr_addr * addr,int size,int * ndel,int flags)2335 pfctl_table_del_addrs(int dev, struct pfr_table *tbl, struct pfr_addr
2336     *addr, int size, int *ndel, int flags)
2337 {
2338 	struct pfioc_table io;
2339 
2340 	if (tbl == NULL || size < 0 || (size && addr == NULL)) {
2341 		return (EINVAL);
2342 	}
2343 	bzero(&io, sizeof io);
2344 	io.pfrio_flags = flags;
2345 	io.pfrio_table = *tbl;
2346 	io.pfrio_buffer = addr;
2347 	io.pfrio_esize = sizeof(*addr);
2348 	io.pfrio_size = size;
2349 
2350 	if (ioctl(dev, DIOCRDELADDRS, &io))
2351 		return (errno);
2352 	if (ndel != NULL)
2353 		*ndel = io.pfrio_ndel;
2354 	return (0);
2355 }
2356 
2357 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)2358 pfctl_table_set_addrs(int dev, struct pfr_table *tbl, struct pfr_addr
2359     *addr, int size, int *size2, int *nadd, int *ndel, int *nchange, int flags)
2360 {
2361 	struct pfioc_table io;
2362 
2363 	if (tbl == NULL || size < 0 || (size && addr == NULL)) {
2364 		return (EINVAL);
2365 	}
2366 	bzero(&io, sizeof io);
2367 	io.pfrio_flags = flags;
2368 	io.pfrio_table = *tbl;
2369 	io.pfrio_buffer = addr;
2370 	io.pfrio_esize = sizeof(*addr);
2371 	io.pfrio_size = size;
2372 	io.pfrio_size2 = (size2 != NULL) ? *size2 : 0;
2373 	if (ioctl(dev, DIOCRSETADDRS, &io))
2374 		return (-1);
2375 	if (nadd != NULL)
2376 		*nadd = io.pfrio_nadd;
2377 	if (ndel != NULL)
2378 		*ndel = io.pfrio_ndel;
2379 	if (nchange != NULL)
2380 		*nchange = io.pfrio_nchange;
2381 	if (size2 != NULL)
2382 		*size2 = io.pfrio_size2;
2383 	return (0);
2384 }
2385 
pfctl_table_get_addrs(int dev,struct pfr_table * tbl,struct pfr_addr * addr,int * size,int flags)2386 int pfctl_table_get_addrs(int dev, struct pfr_table *tbl, struct pfr_addr *addr,
2387     int *size, int flags)
2388 {
2389 	struct pfioc_table io;
2390 
2391 	if (tbl == NULL || size == NULL || *size < 0 ||
2392 	    (*size && addr == NULL)) {
2393 		return (EINVAL);
2394 	}
2395 	bzero(&io, sizeof io);
2396 	io.pfrio_flags = flags;
2397 	io.pfrio_table = *tbl;
2398 	io.pfrio_buffer = addr;
2399 	io.pfrio_esize = sizeof(*addr);
2400 	io.pfrio_size = *size;
2401 	if (ioctl(dev, DIOCRGETADDRS, &io))
2402 		return (-1);
2403 	*size = io.pfrio_size;
2404 	return (0);
2405 }
2406 
2407 int
pfctl_set_statusif(struct pfctl_handle * h,const char * ifname)2408 pfctl_set_statusif(struct pfctl_handle *h, const char *ifname)
2409 {
2410 	struct snl_writer nw;
2411 	struct snl_errmsg_data e = {};
2412 	struct nlmsghdr *hdr;
2413 	uint32_t seq_id;
2414 	int family_id;
2415 
2416 	family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
2417 	if (family_id == 0)
2418 		return (ENOTSUP);
2419 
2420 	snl_init_writer(&h->ss, &nw);
2421 	hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_SET_STATUSIF);
2422 
2423 	snl_add_msg_attr_string(&nw, PF_SS_IFNAME, ifname);
2424 
2425 	if ((hdr = snl_finalize_msg(&nw)) == NULL)
2426 		return (ENXIO);
2427 
2428 	seq_id = hdr->nlmsg_seq;
2429 
2430 	if (! snl_send_message(&h->ss, hdr))
2431 		return (ENXIO);
2432 
2433 	while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
2434 	}
2435 
2436 	return (e.error);
2437 }
2438 
2439 #define	_IN(_field)	offsetof(struct genlmsghdr, _field)
2440 #define	_OUT(_field)	offsetof(struct pfctl_natlook, _field)
2441 static struct snl_attr_parser ap_natlook[] = {
2442 	{ .type = PF_NL_SRC_ADDR, .off = _OUT(saddr), .cb = snl_attr_get_in6_addr },
2443 	{ .type = PF_NL_DST_ADDR, .off = _OUT(daddr), .cb = snl_attr_get_in6_addr },
2444 	{ .type = PF_NL_SRC_PORT, .off = _OUT(sport), .cb = snl_attr_get_uint16 },
2445 	{ .type = PF_NL_DST_PORT, .off = _OUT(dport), .cb = snl_attr_get_uint16 },
2446 };
2447 static struct snl_field_parser fp_natlook[] = {};
2448 #undef _IN
2449 #undef _OUT
2450 SNL_DECLARE_PARSER(natlook_parser, struct genlmsghdr, fp_natlook, ap_natlook);
2451 
2452 int
pfctl_natlook(struct pfctl_handle * h,const struct pfctl_natlook_key * k,struct pfctl_natlook * r)2453 pfctl_natlook(struct pfctl_handle *h, const struct pfctl_natlook_key *k,
2454     struct pfctl_natlook *r)
2455 {
2456 	struct snl_writer nw;
2457 	struct snl_errmsg_data e = {};
2458 	struct nlmsghdr *hdr;
2459 	uint32_t seq_id;
2460 	int family_id;
2461 
2462 	family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
2463 	if (family_id == 0)
2464 		return (ENOTSUP);
2465 
2466 	snl_init_writer(&h->ss, &nw);
2467 	hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_NATLOOK);
2468 	hdr->nlmsg_flags |= NLM_F_DUMP;
2469 
2470 	snl_add_msg_attr_u8(&nw, PF_NL_AF, k->af);
2471 	snl_add_msg_attr_u8(&nw, PF_NL_DIRECTION, k->direction);
2472 	snl_add_msg_attr_u8(&nw, PF_NL_PROTO, k->proto);
2473 	snl_add_msg_attr_ip6(&nw, PF_NL_SRC_ADDR, &k->saddr.v6);
2474 	snl_add_msg_attr_ip6(&nw, PF_NL_DST_ADDR, &k->daddr.v6);
2475 	snl_add_msg_attr_u16(&nw, PF_NL_SRC_PORT, k->sport);
2476 	snl_add_msg_attr_u16(&nw, PF_NL_DST_PORT, k->dport);
2477 
2478 	if ((hdr = snl_finalize_msg(&nw)) == NULL)
2479 		return (ENXIO);
2480 
2481 	seq_id = hdr->nlmsg_seq;
2482 
2483 	if (! snl_send_message(&h->ss, hdr))
2484 		return (ENXIO);
2485 
2486 	while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
2487 		if (! snl_parse_nlmsg(&h->ss, hdr, &natlook_parser, r))
2488 			continue;
2489 	}
2490 
2491 	return (e.error);
2492 }
2493 
2494 int
pfctl_set_debug(struct pfctl_handle * h,uint32_t level)2495 pfctl_set_debug(struct pfctl_handle *h, uint32_t level)
2496 {
2497 	struct snl_writer nw;
2498 	struct snl_errmsg_data e = {};
2499 	struct nlmsghdr *hdr;
2500 	uint32_t seq_id;
2501 	int family_id;
2502 
2503 	family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
2504 	if (family_id == 0)
2505 		return (ENOTSUP);
2506 
2507 	snl_init_writer(&h->ss, &nw);
2508 	hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_SET_DEBUG);
2509 
2510 	snl_add_msg_attr_u32(&nw, PF_SD_LEVEL, level);
2511 
2512 	if ((hdr = snl_finalize_msg(&nw)) == NULL)
2513 		return (ENXIO);
2514 
2515 	seq_id = hdr->nlmsg_seq;
2516 
2517 	if (! snl_send_message(&h->ss, hdr))
2518 		return (ENXIO);
2519 
2520 	while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
2521 	}
2522 
2523 	return (e.error);
2524 }
2525 
2526 int
pfctl_set_timeout(struct pfctl_handle * h,uint32_t timeout,uint32_t seconds)2527 pfctl_set_timeout(struct pfctl_handle *h, uint32_t timeout, uint32_t seconds)
2528 {
2529 	struct snl_writer nw;
2530 	struct snl_errmsg_data e = {};
2531 	struct nlmsghdr *hdr;
2532 	uint32_t seq_id;
2533 	int family_id;
2534 
2535 	family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
2536 	if (family_id == 0)
2537 		return (ENOTSUP);
2538 
2539 	snl_init_writer(&h->ss, &nw);
2540 	hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_SET_TIMEOUT);
2541 
2542 	snl_add_msg_attr_u32(&nw, PF_TO_TIMEOUT, timeout);
2543 	snl_add_msg_attr_u32(&nw, PF_TO_SECONDS, seconds);
2544 
2545 	if ((hdr = snl_finalize_msg(&nw)) == NULL)
2546 		return (ENXIO);
2547 
2548 	seq_id = hdr->nlmsg_seq;
2549 
2550 	if (! snl_send_message(&h->ss, hdr))
2551 		return (ENXIO);
2552 
2553 	while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
2554 	}
2555 
2556 	return (e.error);
2557 }
2558 
2559 struct pfctl_nl_timeout {
2560 	uint32_t seconds;
2561 };
2562 #define	_OUT(_field)	offsetof(struct pfctl_nl_timeout, _field)
2563 static struct snl_attr_parser ap_get_timeout[] = {
2564 	{ .type = PF_TO_SECONDS, .off = _OUT(seconds), .cb = snl_attr_get_uint32 },
2565 };
2566 static struct snl_field_parser fp_get_timeout[] = {};
2567 #undef _OUT
2568 SNL_DECLARE_PARSER(get_timeout_parser, struct genlmsghdr, fp_get_timeout, ap_get_timeout);
2569 
2570 int
pfctl_get_timeout(struct pfctl_handle * h,uint32_t timeout,uint32_t * seconds)2571 pfctl_get_timeout(struct pfctl_handle *h, uint32_t timeout, uint32_t *seconds)
2572 {
2573 	struct snl_writer nw;
2574 	struct pfctl_nl_timeout to = {};
2575 	struct snl_errmsg_data e = {};
2576 	struct nlmsghdr *hdr;
2577 	uint32_t seq_id;
2578 	int family_id;
2579 
2580 	family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
2581 	if (family_id == 0)
2582 		return (ENOTSUP);
2583 
2584 	snl_init_writer(&h->ss, &nw);
2585 	hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_GET_TIMEOUT);
2586 	hdr->nlmsg_flags |= NLM_F_DUMP;
2587 
2588 	snl_add_msg_attr_u32(&nw, PF_TO_TIMEOUT, timeout);
2589 
2590 	if ((hdr = snl_finalize_msg(&nw)) == NULL)
2591 		return (ENXIO);
2592 
2593 	seq_id = hdr->nlmsg_seq;
2594 
2595 	if (! snl_send_message(&h->ss, hdr))
2596 		return (ENXIO);
2597 
2598 	while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
2599 		if (! snl_parse_nlmsg(&h->ss, hdr, &get_timeout_parser, &to))
2600 			continue;
2601 	}
2602 
2603 	if (seconds != NULL)
2604 		*seconds = to.seconds;
2605 
2606 	return (e.error);
2607 }
2608 
2609 int
pfctl_set_limit(struct pfctl_handle * h,const int index,const uint limit)2610 pfctl_set_limit(struct pfctl_handle *h, const int index, const uint limit)
2611 {
2612 	struct snl_writer nw;
2613 	struct snl_errmsg_data e = {};
2614 	struct nlmsghdr *hdr;
2615 	uint32_t seq_id;
2616 	int family_id;
2617 
2618 	family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
2619 	if (family_id == 0)
2620 		return (ENOTSUP);
2621 
2622 	snl_init_writer(&h->ss, &nw);
2623 	hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_SET_LIMIT);
2624 
2625 	snl_add_msg_attr_u32(&nw, PF_LI_INDEX, index);
2626 	snl_add_msg_attr_u32(&nw, PF_LI_LIMIT, limit);
2627 
2628 	if ((hdr = snl_finalize_msg(&nw)) == NULL)
2629 		return (ENXIO);
2630 
2631 	seq_id = hdr->nlmsg_seq;
2632 
2633 	if (! snl_send_message(&h->ss, hdr))
2634 		return (ENXIO);
2635 
2636 	while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
2637 	}
2638 
2639 	return (e.error);
2640 }
2641 
2642 struct pfctl_nl_limit {
2643 	unsigned int limit;
2644 };
2645 #define	_OUT(_field)	offsetof(struct pfctl_nl_limit, _field)
2646 static struct snl_attr_parser ap_get_limit[] = {
2647 	{ .type = PF_LI_LIMIT, .off = _OUT(limit), .cb = snl_attr_get_uint32 },
2648 };
2649 static struct snl_field_parser fp_get_limit[] = {};
2650 #undef _OUT
2651 SNL_DECLARE_PARSER(get_limit_parser, struct genlmsghdr, fp_get_limit, ap_get_limit);
2652 
2653 int
pfctl_get_limit(struct pfctl_handle * h,const int index,uint * limit)2654 pfctl_get_limit(struct pfctl_handle *h, const int index, uint *limit)
2655 {
2656 	struct snl_writer nw;
2657 	struct pfctl_nl_limit li = {};
2658 	struct snl_errmsg_data e = {};
2659 	struct nlmsghdr *hdr;
2660 	uint32_t seq_id;
2661 	int family_id;
2662 
2663 	family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
2664 	if (family_id == 0)
2665 		return (ENOTSUP);
2666 
2667 	snl_init_writer(&h->ss, &nw);
2668 	hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_GET_LIMIT);
2669 	hdr->nlmsg_flags |= NLM_F_DUMP;
2670 
2671 	snl_add_msg_attr_u32(&nw, PF_LI_INDEX, index);
2672 
2673 	if ((hdr = snl_finalize_msg(&nw)) == NULL)
2674 		return (ENXIO);
2675 
2676 	seq_id = hdr->nlmsg_seq;
2677 
2678 	if (! snl_send_message(&h->ss, hdr))
2679 		return (ENXIO);
2680 
2681 	while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
2682 		if (! snl_parse_nlmsg(&h->ss, hdr, &get_limit_parser, &li))
2683 			continue;
2684 	}
2685 
2686 	if (limit != NULL)
2687 		*limit = li.limit;
2688 
2689 	return (e.error);
2690 }
2691 
2692 struct pfctl_nl_begin_addrs {
2693 	uint32_t ticket;
2694 };
2695 #define	_OUT(_field)	offsetof(struct pfctl_nl_begin_addrs, _field)
2696 static struct snl_attr_parser ap_begin_addrs[] = {
2697 	{ .type = PF_BA_TICKET, .off = _OUT(ticket), .cb = snl_attr_get_uint32 },
2698 };
2699 static struct snl_field_parser fp_begin_addrs[] = {};
2700 #undef _OUT
2701 SNL_DECLARE_PARSER(begin_addrs_parser, struct genlmsghdr, fp_begin_addrs, ap_begin_addrs);
2702 
2703 int
pfctl_begin_addrs(struct pfctl_handle * h,uint32_t * ticket)2704 pfctl_begin_addrs(struct pfctl_handle *h, uint32_t *ticket)
2705 {
2706 	struct snl_writer nw;
2707 	struct pfctl_nl_begin_addrs attrs = {};
2708 	struct snl_errmsg_data e = {};
2709 	struct nlmsghdr *hdr;
2710 	uint32_t seq_id;
2711 	int family_id;
2712 
2713 	family_id = snl_get_genl_family(&h->ss, PFNL_FAMILY_NAME);
2714 	if (family_id == 0)
2715 		return (ENOTSUP);
2716 
2717 	snl_init_writer(&h->ss, &nw);
2718 	hdr = snl_create_genl_msg_request(&nw, family_id, PFNL_CMD_BEGIN_ADDRS);
2719 	hdr->nlmsg_flags |= NLM_F_DUMP;
2720 
2721 	if ((hdr = snl_finalize_msg(&nw)) == NULL)
2722 		return (ENXIO);
2723 
2724 	seq_id = hdr->nlmsg_seq;
2725 
2726 	if (! snl_send_message(&h->ss, hdr))
2727 		return (ENXIO);
2728 
2729 	while ((hdr = snl_read_reply_multi(&h->ss, seq_id, &e)) != NULL) {
2730 		if (! snl_parse_nlmsg(&h->ss, hdr, &begin_addrs_parser, &attrs))
2731 			continue;
2732 	}
2733 
2734 	if (ticket != NULL)
2735 		*ticket = attrs.ticket;
2736 
2737 	return (e.error);
2738 }
2739 
2740