npf_data.c revision 1.21 1 1.21 rmind /* $NetBSD: npf_data.c,v 1.21 2013/11/08 00:38:26 rmind Exp $ */
2 1.1 rmind
3 1.1 rmind /*-
4 1.10 rmind * Copyright (c) 2009-2012 The NetBSD Foundation, Inc.
5 1.1 rmind * All rights reserved.
6 1.1 rmind *
7 1.1 rmind * Redistribution and use in source and binary forms, with or without
8 1.1 rmind * modification, are permitted provided that the following conditions
9 1.1 rmind * are met:
10 1.1 rmind * 1. Redistributions of source code must retain the above copyright
11 1.1 rmind * notice, this list of conditions and the following disclaimer.
12 1.1 rmind * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 rmind * notice, this list of conditions and the following disclaimer in the
14 1.1 rmind * documentation and/or other materials provided with the distribution.
15 1.1 rmind *
16 1.1 rmind * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
17 1.1 rmind * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
18 1.1 rmind * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
19 1.1 rmind * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
20 1.1 rmind * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
21 1.1 rmind * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
22 1.1 rmind * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
23 1.1 rmind * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
24 1.1 rmind * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
25 1.1 rmind * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
26 1.1 rmind * POSSIBILITY OF SUCH DAMAGE.
27 1.1 rmind */
28 1.1 rmind
29 1.1 rmind /*
30 1.10 rmind * npfctl(8) data manipulation and helper routines.
31 1.1 rmind */
32 1.1 rmind
33 1.4 rmind #include <sys/cdefs.h>
34 1.21 rmind __RCSID("$NetBSD: npf_data.c,v 1.21 2013/11/08 00:38:26 rmind Exp $");
35 1.4 rmind
36 1.1 rmind #include <sys/types.h>
37 1.10 rmind #include <sys/null.h>
38 1.10 rmind
39 1.10 rmind #include <netinet/in.h>
40 1.10 rmind #include <netinet/in_systm.h>
41 1.10 rmind #include <netinet/ip.h>
42 1.10 rmind #define ICMP_STRINGS
43 1.10 rmind #include <netinet/ip_icmp.h>
44 1.16 spz #define ICMP6_STRINGS
45 1.16 spz #include <netinet/icmp6.h>
46 1.10 rmind #include <netinet/tcp.h>
47 1.1 rmind #include <net/if.h>
48 1.1 rmind
49 1.1 rmind #include <stdlib.h>
50 1.21 rmind #include <stddef.h>
51 1.1 rmind #include <string.h>
52 1.21 rmind #include <ctype.h>
53 1.1 rmind #include <err.h>
54 1.10 rmind #include <errno.h>
55 1.1 rmind #include <ifaddrs.h>
56 1.1 rmind #include <netdb.h>
57 1.1 rmind
58 1.1 rmind #include "npfctl.h"
59 1.1 rmind
60 1.1 rmind static struct ifaddrs * ifs_list = NULL;
61 1.1 rmind
62 1.21 rmind void
63 1.21 rmind npfctl_note_interface(const char *ifname)
64 1.21 rmind {
65 1.21 rmind unsigned long if_idx = if_nametoindex(ifname);
66 1.21 rmind bool testif = npfctl_debug_addif(ifname);
67 1.21 rmind const char *p = ifname;
68 1.21 rmind
69 1.21 rmind /* If such interface exists or if it is a test interface - done. */
70 1.21 rmind if (if_idx || testif) {
71 1.21 rmind return;
72 1.21 rmind }
73 1.21 rmind
74 1.21 rmind /*
75 1.21 rmind * Minimum sanity check. The interface name shall be non-empty
76 1.21 rmind * string shorter than IFNAMSIZ and alphanumeric only.
77 1.21 rmind */
78 1.21 rmind if (*p == '\0') {
79 1.21 rmind goto invalid;
80 1.21 rmind }
81 1.21 rmind while (*p) {
82 1.21 rmind const size_t len = (ptrdiff_t)p - (ptrdiff_t)ifname;
83 1.21 rmind
84 1.21 rmind if (!isalnum((unsigned char)*p) || len > IFNAMSIZ) {
85 1.21 rmind invalid: yyerror("illegitimate interface name '%s'", ifname);
86 1.21 rmind }
87 1.21 rmind p++;
88 1.21 rmind }
89 1.21 rmind
90 1.21 rmind /* Throw a warning, so that the user could double check. */
91 1.21 rmind warnx("warning - unknown interface '%s'", ifname);
92 1.21 rmind }
93 1.21 rmind
94 1.21 rmind static unsigned long
95 1.10 rmind npfctl_find_ifindex(const char *ifname)
96 1.1 rmind {
97 1.18 rmind unsigned long if_idx = if_nametoindex(ifname);
98 1.21 rmind bool testif = npfctl_debug_addif(ifname);
99 1.18 rmind
100 1.18 rmind if (!if_idx) {
101 1.21 rmind if (testif) {
102 1.21 rmind static u_int dummy_if_idx = (1 << 15);
103 1.21 rmind return ++dummy_if_idx;
104 1.18 rmind }
105 1.18 rmind yyerror("unknown interface '%s'", ifname);
106 1.18 rmind }
107 1.18 rmind return if_idx;
108 1.1 rmind }
109 1.1 rmind
110 1.10 rmind static bool
111 1.10 rmind npfctl_copy_address(sa_family_t fam, npf_addr_t *addr, const void *ptr)
112 1.1 rmind {
113 1.14 rmind memset(addr, 0, sizeof(npf_addr_t));
114 1.14 rmind
115 1.10 rmind switch (fam) {
116 1.10 rmind case AF_INET: {
117 1.10 rmind const struct sockaddr_in *sin = ptr;
118 1.10 rmind memcpy(addr, &sin->sin_addr, sizeof(sin->sin_addr));
119 1.10 rmind return true;
120 1.10 rmind }
121 1.10 rmind case AF_INET6: {
122 1.10 rmind const struct sockaddr_in6 *sin6 = ptr;
123 1.10 rmind memcpy(addr, &sin6->sin6_addr, sizeof(sin6->sin6_addr));
124 1.10 rmind return true;
125 1.10 rmind }
126 1.10 rmind default:
127 1.10 rmind yyerror("unknown address family %u", fam);
128 1.10 rmind return false;
129 1.10 rmind }
130 1.5 rmind }
131 1.5 rmind
132 1.10 rmind static bool
133 1.10 rmind npfctl_parse_fam_addr(const char *name, sa_family_t *fam, npf_addr_t *addr)
134 1.1 rmind {
135 1.10 rmind static const struct addrinfo hint = {
136 1.10 rmind .ai_family = AF_UNSPEC,
137 1.10 rmind .ai_flags = AI_NUMERICHOST
138 1.10 rmind };
139 1.10 rmind struct addrinfo *ai;
140 1.10 rmind int ret;
141 1.1 rmind
142 1.10 rmind ret = getaddrinfo(name, NULL, &hint, &ai);
143 1.10 rmind if (ret) {
144 1.10 rmind yyerror("cannot parse '%s' (%s)", name, gai_strerror(ret));
145 1.10 rmind return false;
146 1.10 rmind }
147 1.10 rmind if (fam) {
148 1.10 rmind *fam = ai->ai_family;
149 1.1 rmind }
150 1.10 rmind if (!npfctl_copy_address(*fam, addr, ai->ai_addr)) {
151 1.10 rmind return false;
152 1.1 rmind }
153 1.10 rmind freeaddrinfo(ai);
154 1.10 rmind return true;
155 1.1 rmind }
156 1.1 rmind
157 1.10 rmind static bool
158 1.10 rmind npfctl_parse_mask(const char *s, sa_family_t fam, npf_netmask_t *mask)
159 1.3 rmind {
160 1.10 rmind char *ep = NULL;
161 1.10 rmind npf_addr_t addr;
162 1.10 rmind uint8_t *ap;
163 1.10 rmind
164 1.10 rmind if (s) {
165 1.10 rmind errno = 0;
166 1.10 rmind *mask = (npf_netmask_t)strtol(s, &ep, 0);
167 1.10 rmind if (*ep == '\0' && s != ep && errno != ERANGE)
168 1.10 rmind return true;
169 1.10 rmind if (!npfctl_parse_fam_addr(s, &fam, &addr))
170 1.10 rmind return false;
171 1.10 rmind }
172 1.3 rmind
173 1.15 rmind assert(fam == AF_INET || fam == AF_INET6);
174 1.15 rmind *mask = NPF_NO_NETMASK;
175 1.10 rmind if (ep == NULL) {
176 1.10 rmind return true;
177 1.10 rmind }
178 1.15 rmind
179 1.10 rmind ap = addr.s6_addr + (*mask / 8) - 1;
180 1.10 rmind while (ap >= addr.s6_addr) {
181 1.10 rmind for (int j = 8; j > 0; j--) {
182 1.10 rmind if (*ap & 1)
183 1.10 rmind return true;
184 1.10 rmind *ap >>= 1;
185 1.10 rmind (*mask)--;
186 1.10 rmind if (*mask == 0)
187 1.10 rmind return true;
188 1.3 rmind }
189 1.10 rmind ap--;
190 1.3 rmind }
191 1.3 rmind return true;
192 1.1 rmind }
193 1.1 rmind
194 1.10 rmind /*
195 1.10 rmind * npfctl_parse_fam_addr_mask: return address family, address and mask.
196 1.10 rmind *
197 1.10 rmind * => Mask is optional and can be NULL.
198 1.10 rmind * => Returns true on success or false if unable to parse.
199 1.10 rmind */
200 1.10 rmind npfvar_t *
201 1.10 rmind npfctl_parse_fam_addr_mask(const char *addr, const char *mask,
202 1.10 rmind unsigned long *nummask)
203 1.8 zoltan {
204 1.10 rmind npfvar_t *vp = npfvar_create(".addr");
205 1.10 rmind fam_addr_mask_t fam;
206 1.10 rmind
207 1.10 rmind memset(&fam, 0, sizeof(fam));
208 1.8 zoltan
209 1.10 rmind if (!npfctl_parse_fam_addr(addr, &fam.fam_family, &fam.fam_addr))
210 1.10 rmind goto out;
211 1.10 rmind
212 1.10 rmind /*
213 1.10 rmind * Note: both mask and nummask may be NULL. In such case,
214 1.10 rmind * npfctl_parse_mask() will handle and will set full mask.
215 1.10 rmind */
216 1.10 rmind if (nummask) {
217 1.10 rmind fam.fam_mask = *nummask;
218 1.10 rmind } else if (!npfctl_parse_mask(mask, fam.fam_family, &fam.fam_mask)) {
219 1.10 rmind goto out;
220 1.8 zoltan }
221 1.8 zoltan
222 1.10 rmind if (!npfvar_add_element(vp, NPFVAR_FAM, &fam, sizeof(fam)))
223 1.10 rmind goto out;
224 1.1 rmind
225 1.10 rmind return vp;
226 1.10 rmind out:
227 1.10 rmind npfvar_destroy(vp);
228 1.10 rmind return NULL;
229 1.1 rmind }
230 1.1 rmind
231 1.10 rmind npfvar_t *
232 1.10 rmind npfctl_parse_table_id(const char *id)
233 1.3 rmind {
234 1.10 rmind npfvar_t *vp;
235 1.3 rmind
236 1.10 rmind if (!npfctl_table_exists_p(id)) {
237 1.10 rmind yyerror("table '%s' is not defined", id);
238 1.10 rmind return NULL;
239 1.3 rmind }
240 1.10 rmind vp = npfvar_create(".table");
241 1.10 rmind
242 1.10 rmind if (!npfvar_add_element(vp, NPFVAR_TABLE, id, strlen(id) + 1))
243 1.10 rmind goto out;
244 1.10 rmind
245 1.10 rmind return vp;
246 1.10 rmind out:
247 1.10 rmind npfvar_destroy(vp);
248 1.10 rmind return NULL;
249 1.3 rmind }
250 1.3 rmind
251 1.10 rmind /*
252 1.10 rmind * npfctl_parse_port_range: create a port-range variable. Note that the
253 1.12 rmind * passed port numbers should be in host byte order.
254 1.10 rmind */
255 1.10 rmind npfvar_t *
256 1.10 rmind npfctl_parse_port_range(in_port_t s, in_port_t e)
257 1.1 rmind {
258 1.10 rmind npfvar_t *vp = npfvar_create(".port_range");
259 1.10 rmind port_range_t pr;
260 1.1 rmind
261 1.12 rmind pr.pr_start = htons(s);
262 1.12 rmind pr.pr_end = htons(e);
263 1.1 rmind
264 1.10 rmind if (!npfvar_add_element(vp, NPFVAR_PORT_RANGE, &pr, sizeof(pr)))
265 1.10 rmind goto out;
266 1.1 rmind
267 1.10 rmind return vp;
268 1.10 rmind out:
269 1.10 rmind npfvar_destroy(vp);
270 1.10 rmind return NULL;
271 1.1 rmind }
272 1.1 rmind
273 1.10 rmind npfvar_t *
274 1.11 christos npfctl_parse_port_range_variable(const char *v)
275 1.11 christos {
276 1.11 christos npfvar_t *vp = npfvar_lookup(v);
277 1.11 christos size_t count = npfvar_get_count(vp);
278 1.11 christos npfvar_t *pvp = npfvar_create(".port_range");
279 1.12 rmind port_range_t *pr;
280 1.12 rmind in_port_t p;
281 1.11 christos
282 1.11 christos for (size_t i = 0; i < count; i++) {
283 1.11 christos int type = npfvar_get_type(vp, i);
284 1.11 christos void *data = npfvar_get_data(vp, type, i);
285 1.12 rmind
286 1.11 christos switch (type) {
287 1.11 christos case NPFVAR_IDENTIFIER:
288 1.11 christos case NPFVAR_STRING:
289 1.11 christos p = npfctl_portno(data);
290 1.11 christos npfvar_add_elements(pvp, npfctl_parse_port_range(p, p));
291 1.11 christos break;
292 1.11 christos case NPFVAR_PORT_RANGE:
293 1.11 christos pr = data;
294 1.11 christos npfvar_add_element(pvp, NPFVAR_PORT_RANGE, pr,
295 1.11 christos sizeof(*pr));
296 1.11 christos break;
297 1.11 christos case NPFVAR_NUM:
298 1.11 christos p = *(unsigned long *)data;
299 1.11 christos npfvar_add_elements(pvp, npfctl_parse_port_range(p, p));
300 1.11 christos break;
301 1.11 christos default:
302 1.11 christos yyerror("wrong variable '%s' type '%s' for port range",
303 1.11 christos v, npfvar_type(type));
304 1.12 rmind npfvar_destroy(pvp);
305 1.12 rmind return NULL;
306 1.11 christos }
307 1.11 christos }
308 1.11 christos return pvp;
309 1.11 christos }
310 1.11 christos
311 1.11 christos npfvar_t *
312 1.19 rmind npfctl_parse_ifnet(const char *ifname, const int family)
313 1.10 rmind {
314 1.19 rmind npfvar_t *vpa, *vp;
315 1.10 rmind struct ifaddrs *ifa;
316 1.19 rmind ifnet_addr_t ifna;
317 1.1 rmind
318 1.10 rmind if (ifs_list == NULL && getifaddrs(&ifs_list) == -1) {
319 1.10 rmind err(EXIT_FAILURE, "getifaddrs");
320 1.10 rmind }
321 1.1 rmind
322 1.19 rmind vpa = npfvar_create(".ifaddrs");
323 1.21 rmind ifna.ifna_name = estrdup(ifname);
324 1.19 rmind ifna.ifna_addrs = vpa;
325 1.19 rmind ifna.ifna_index = npfctl_find_ifindex(ifname);
326 1.19 rmind assert(ifna.ifna_index != 0);
327 1.1 rmind
328 1.10 rmind for (ifa = ifs_list; ifa != NULL; ifa = ifa->ifa_next) {
329 1.19 rmind fam_addr_mask_t fam;
330 1.10 rmind struct sockaddr *sa;
331 1.1 rmind
332 1.10 rmind if (strcmp(ifa->ifa_name, ifname) != 0)
333 1.10 rmind continue;
334 1.1 rmind
335 1.10 rmind if ((ifa->ifa_flags & IFF_UP) == 0)
336 1.10 rmind warnx("interface '%s' is down", ifname);
337 1.10 rmind
338 1.10 rmind sa = ifa->ifa_addr;
339 1.19 rmind if (sa->sa_family != AF_INET && sa->sa_family != AF_INET6)
340 1.19 rmind continue;
341 1.19 rmind if (family != AF_UNSPEC && sa->sa_family != family)
342 1.10 rmind continue;
343 1.1 rmind
344 1.19 rmind memset(&fam, 0, sizeof(fam));
345 1.19 rmind fam.fam_family = sa->sa_family;
346 1.19 rmind fam.fam_ifindex = ifna.ifna_index;
347 1.1 rmind
348 1.19 rmind if (!npfctl_copy_address(sa->sa_family, &fam.fam_addr, sa))
349 1.10 rmind goto out;
350 1.1 rmind
351 1.10 rmind if (!npfctl_parse_mask(NULL, fam.fam_family, &fam.fam_mask))
352 1.10 rmind goto out;
353 1.1 rmind
354 1.19 rmind if (!npfvar_add_element(vpa, NPFVAR_FAM, &fam, sizeof(fam)))
355 1.10 rmind goto out;
356 1.10 rmind }
357 1.19 rmind if (npfvar_get_count(vpa) == 0) {
358 1.10 rmind yyerror("no addresses matched for interface '%s'", ifname);
359 1.10 rmind goto out;
360 1.1 rmind }
361 1.19 rmind
362 1.19 rmind vp = npfvar_create(".interface");
363 1.19 rmind npfvar_add_element(vp, NPFVAR_INTERFACE, &ifna, sizeof(ifna));
364 1.10 rmind return vp;
365 1.10 rmind out:
366 1.19 rmind npfvar_destroy(ifna.ifna_addrs);
367 1.10 rmind return NULL;
368 1.1 rmind }
369 1.1 rmind
370 1.15 rmind bool
371 1.15 rmind npfctl_parse_cidr(char *cidr, fam_addr_mask_t *fam, int *alen)
372 1.1 rmind {
373 1.15 rmind char *mask, *p;
374 1.1 rmind
375 1.15 rmind p = strchr(cidr, '\n');
376 1.10 rmind if (p) {
377 1.15 rmind *p = '\0';
378 1.15 rmind }
379 1.15 rmind mask = strchr(cidr, '/');
380 1.15 rmind if (mask) {
381 1.15 rmind *mask++ = '\0';
382 1.1 rmind }
383 1.15 rmind
384 1.15 rmind memset(fam, 0, sizeof(*fam));
385 1.15 rmind if (!npfctl_parse_fam_addr(cidr, &fam->fam_family, &fam->fam_addr)) {
386 1.15 rmind return false;
387 1.15 rmind }
388 1.15 rmind if (!npfctl_parse_mask(mask, fam->fam_family, &fam->fam_mask)) {
389 1.15 rmind return false;
390 1.15 rmind }
391 1.15 rmind switch (fam->fam_family) {
392 1.15 rmind case AF_INET:
393 1.15 rmind *alen = sizeof(struct in_addr);
394 1.15 rmind break;
395 1.15 rmind case AF_INET6:
396 1.15 rmind *alen = sizeof(struct in6_addr);
397 1.15 rmind break;
398 1.15 rmind default:
399 1.15 rmind return false;
400 1.1 rmind }
401 1.15 rmind return true;
402 1.1 rmind }
403 1.1 rmind
404 1.14 rmind int
405 1.14 rmind npfctl_protono(const char *proto)
406 1.14 rmind {
407 1.14 rmind struct protoent *pe;
408 1.14 rmind
409 1.14 rmind pe = getprotobyname(proto);
410 1.14 rmind if (pe == NULL) {
411 1.14 rmind yyerror("unknown protocol '%s'", proto);
412 1.14 rmind return -1;
413 1.14 rmind }
414 1.14 rmind return pe->p_proto;
415 1.14 rmind }
416 1.14 rmind
417 1.10 rmind /*
418 1.10 rmind * npfctl_portno: convert port identifier (string) to a number.
419 1.10 rmind *
420 1.12 rmind * => Returns port number in host byte order.
421 1.10 rmind */
422 1.10 rmind in_port_t
423 1.10 rmind npfctl_portno(const char *port)
424 1.1 rmind {
425 1.10 rmind struct addrinfo *ai, *rai;
426 1.10 rmind in_port_t p = 0;
427 1.10 rmind int e;
428 1.10 rmind
429 1.10 rmind e = getaddrinfo(NULL, port, NULL, &rai);
430 1.10 rmind if (e != 0) {
431 1.14 rmind yyerror("invalid port name '%s' (%s)", port, gai_strerror(e));
432 1.10 rmind return 0;
433 1.10 rmind }
434 1.10 rmind
435 1.10 rmind for (ai = rai; ai; ai = ai->ai_next) {
436 1.10 rmind switch (ai->ai_family) {
437 1.10 rmind case AF_INET: {
438 1.10 rmind struct sockaddr_in *sin = (void *)ai->ai_addr;
439 1.10 rmind p = sin->sin_port;
440 1.10 rmind goto out;
441 1.10 rmind }
442 1.10 rmind case AF_INET6: {
443 1.10 rmind struct sockaddr_in6 *sin6 = (void *)ai->ai_addr;
444 1.10 rmind p = sin6->sin6_port;
445 1.10 rmind goto out;
446 1.8 zoltan }
447 1.10 rmind default:
448 1.10 rmind break;
449 1.8 zoltan }
450 1.1 rmind }
451 1.10 rmind out:
452 1.10 rmind freeaddrinfo(rai);
453 1.12 rmind return ntohs(p);
454 1.10 rmind }
455 1.1 rmind
456 1.10 rmind npfvar_t *
457 1.10 rmind npfctl_parse_tcpflag(const char *s)
458 1.10 rmind {
459 1.10 rmind uint8_t tfl = 0;
460 1.3 rmind
461 1.10 rmind while (*s) {
462 1.10 rmind switch (*s) {
463 1.10 rmind case 'F': tfl |= TH_FIN; break;
464 1.10 rmind case 'S': tfl |= TH_SYN; break;
465 1.10 rmind case 'R': tfl |= TH_RST; break;
466 1.10 rmind case 'P': tfl |= TH_PUSH; break;
467 1.10 rmind case 'A': tfl |= TH_ACK; break;
468 1.10 rmind case 'U': tfl |= TH_URG; break;
469 1.10 rmind case 'E': tfl |= TH_ECE; break;
470 1.10 rmind case 'W': tfl |= TH_CWR; break;
471 1.10 rmind default:
472 1.10 rmind yyerror("invalid flag '%c'", *s);
473 1.10 rmind return NULL;
474 1.3 rmind }
475 1.10 rmind s++;
476 1.1 rmind }
477 1.1 rmind
478 1.10 rmind npfvar_t *vp = npfvar_create(".tcp_flag");
479 1.10 rmind if (!npfvar_add_element(vp, NPFVAR_TCPFLAG, &tfl, sizeof(tfl))) {
480 1.10 rmind npfvar_destroy(vp);
481 1.10 rmind return NULL;
482 1.10 rmind }
483 1.10 rmind
484 1.10 rmind return vp;
485 1.10 rmind }
486 1.10 rmind
487 1.10 rmind uint8_t
488 1.16 spz npfctl_icmptype(int proto, const char *type)
489 1.10 rmind {
490 1.16 spz uint8_t ul;
491 1.16 spz
492 1.16 spz switch (proto) {
493 1.16 spz case IPPROTO_ICMP:
494 1.16 spz for (ul = 0; icmp_type[ul]; ul++)
495 1.16 spz if (strcmp(icmp_type[ul], type) == 0)
496 1.16 spz return ul;
497 1.16 spz break;
498 1.16 spz case IPPROTO_ICMPV6:
499 1.16 spz for (ul = 0; icmp6_type_err[ul]; ul++)
500 1.16 spz if (strcmp(icmp6_type_err[ul], type) == 0)
501 1.16 spz return ul;
502 1.16 spz for (ul = 0; icmp6_type_info[ul]; ul++)
503 1.16 spz if (strcmp(icmp6_type_info[ul], type) == 0)
504 1.16 spz return (ul+128);
505 1.16 spz break;
506 1.16 spz default:
507 1.16 spz assert(false);
508 1.16 spz }
509 1.16 spz
510 1.16 spz yyerror("unknown icmp-type %s", type);
511 1.10 rmind return ~0;
512 1.10 rmind }
513 1.10 rmind
514 1.10 rmind uint8_t
515 1.16 spz npfctl_icmpcode(int proto, uint8_t type, const char *code)
516 1.10 rmind {
517 1.17 rmind const char * const *arr;
518 1.10 rmind
519 1.16 spz switch (proto) {
520 1.16 spz case IPPROTO_ICMP:
521 1.16 spz switch (type) {
522 1.16 spz case ICMP_ECHOREPLY:
523 1.16 spz case ICMP_SOURCEQUENCH:
524 1.16 spz case ICMP_ALTHOSTADDR:
525 1.16 spz case ICMP_ECHO:
526 1.16 spz case ICMP_ROUTERSOLICIT:
527 1.16 spz case ICMP_TSTAMP:
528 1.16 spz case ICMP_TSTAMPREPLY:
529 1.16 spz case ICMP_IREQ:
530 1.16 spz case ICMP_IREQREPLY:
531 1.16 spz case ICMP_MASKREQ:
532 1.16 spz case ICMP_MASKREPLY:
533 1.16 spz arr = icmp_code_none;
534 1.16 spz break;
535 1.16 spz case ICMP_ROUTERADVERT:
536 1.16 spz arr = icmp_code_routeradvert;
537 1.16 spz break;
538 1.16 spz case ICMP_UNREACH:
539 1.16 spz arr = icmp_code_unreach;
540 1.16 spz break;
541 1.16 spz case ICMP_REDIRECT:
542 1.16 spz arr = icmp_code_redirect;
543 1.16 spz break;
544 1.16 spz case ICMP_TIMXCEED:
545 1.16 spz arr = icmp_code_timxceed;
546 1.16 spz break;
547 1.16 spz case ICMP_PARAMPROB:
548 1.16 spz arr = icmp_code_paramprob;
549 1.16 spz break;
550 1.16 spz case ICMP_PHOTURIS:
551 1.16 spz arr = icmp_code_photuris;
552 1.16 spz break;
553 1.16 spz default:
554 1.16 spz yyerror("unknown icmp-type %d while parsing code %s",
555 1.16 spz type, code);
556 1.16 spz return ~0;
557 1.16 spz }
558 1.10 rmind break;
559 1.16 spz case IPPROTO_ICMPV6:
560 1.16 spz switch (type) {
561 1.16 spz case ICMP6_DST_UNREACH:
562 1.16 spz arr = icmp6_code_unreach;
563 1.16 spz break;
564 1.16 spz case ICMP6_TIME_EXCEEDED:
565 1.16 spz arr = icmp6_code_timxceed;
566 1.16 spz break;
567 1.16 spz case ICMP6_PARAM_PROB:
568 1.16 spz arr = icmp6_code_paramprob;
569 1.16 spz break;
570 1.16 spz case ICMP6_PACKET_TOO_BIG:
571 1.16 spz /* code-less info ICMPs */
572 1.16 spz case ICMP6_ECHO_REQUEST:
573 1.16 spz case ICMP6_ECHO_REPLY:
574 1.16 spz case MLD_LISTENER_QUERY:
575 1.16 spz case MLD_LISTENER_REPORT:
576 1.16 spz case MLD_LISTENER_DONE:
577 1.16 spz case ND_ROUTER_SOLICIT:
578 1.16 spz case ND_ROUTER_ADVERT:
579 1.16 spz case ND_NEIGHBOR_SOLICIT:
580 1.16 spz case ND_NEIGHBOR_ADVERT:
581 1.16 spz case ND_REDIRECT:
582 1.16 spz arr = icmp6_code_none;
583 1.16 spz break;
584 1.16 spz /* XXX TODO: info ICMPs with code values */
585 1.16 spz default:
586 1.16 spz yyerror("unknown icmp-type %d while parsing code %s",
587 1.16 spz type, code);
588 1.16 spz return ~0;
589 1.16 spz }
590 1.10 rmind break;
591 1.10 rmind default:
592 1.16 spz assert(false);
593 1.10 rmind }
594 1.10 rmind
595 1.10 rmind for (uint8_t ul = 0; arr[ul]; ul++) {
596 1.10 rmind if (strcmp(arr[ul], code) == 0)
597 1.10 rmind return ul;
598 1.10 rmind }
599 1.16 spz yyerror("unknown code %s for icmp-type %d", code, type);
600 1.10 rmind return ~0;
601 1.10 rmind }
602 1.10 rmind
603 1.10 rmind npfvar_t *
604 1.16 spz npfctl_parse_icmp(int proto, int type, int code)
605 1.10 rmind {
606 1.18 rmind npfvar_t *vp = npfvar_create(".icmp");
607 1.16 spz
608 1.20 rmind if (!npfvar_add_element(vp, NPFVAR_ICMP, &type, sizeof(type)))
609 1.10 rmind goto out;
610 1.10 rmind
611 1.20 rmind if (!npfvar_add_element(vp, NPFVAR_ICMP, &code, sizeof(code)))
612 1.10 rmind goto out;
613 1.10 rmind
614 1.10 rmind return vp;
615 1.10 rmind out:
616 1.10 rmind npfvar_destroy(vp);
617 1.10 rmind return NULL;
618 1.1 rmind }
619