libnftnl  1.0.8
exthdr.c
1 /*
2  * (C) 2012-2013 by Pablo Neira Ayuso <pablo@netfilter.org>
3  *
4  * This program is free software; you can redistribute it and/or modify
5  * it under the terms of the GNU General Public License as published
6  * by the Free Software Foundation; either version 2 of the License, or
7  * (at your option) any later version.
8  *
9  * This code has been sponsored by Sophos Astaro <http://www.sophos.com>
10  */
11 
12 #include "internal.h"
13 
14 #include <stdio.h>
15 #include <string.h>
16 #include <stdint.h>
17 #include <limits.h>
18 #include <arpa/inet.h>
19 #include <errno.h>
20 #include <libmnl/libmnl.h>
21 
22 #include <linux/netfilter/nf_tables.h>
23 
24 #include <libnftnl/expr.h>
25 #include <libnftnl/rule.h>
26 
27 #ifndef IPPROTO_MH
28 #define IPPROTO_MH 135
29 #endif
30 
32  enum nft_registers dreg;
33  enum nft_registers sreg;
34  uint32_t offset;
35  uint32_t len;
36  uint8_t type;
37  uint32_t op;
38  uint32_t flags;
39 };
40 
41 static int
42 nftnl_expr_exthdr_set(struct nftnl_expr *e, uint16_t type,
43  const void *data, uint32_t data_len)
44 {
45  struct nftnl_expr_exthdr *exthdr = nftnl_expr_data(e);
46 
47  switch(type) {
48  case NFTNL_EXPR_EXTHDR_DREG:
49  exthdr->dreg = *((uint32_t *)data);
50  break;
51  case NFTNL_EXPR_EXTHDR_TYPE:
52  exthdr->type = *((uint8_t *)data);
53  break;
54  case NFTNL_EXPR_EXTHDR_OFFSET:
55  exthdr->offset = *((uint32_t *)data);
56  break;
57  case NFTNL_EXPR_EXTHDR_LEN:
58  exthdr->len = *((uint32_t *)data);
59  break;
60  case NFTNL_EXPR_EXTHDR_OP:
61  exthdr->op = *((uint32_t *)data);
62  break;
63  case NFTNL_EXPR_EXTHDR_FLAGS:
64  exthdr->flags = *((uint32_t *)data);
65  break;
66  case NFTNL_EXPR_EXTHDR_SREG:
67  exthdr->sreg = *((uint32_t *)data);
68  break;
69  default:
70  return -1;
71  }
72  return 0;
73 }
74 
75 static const void *
76 nftnl_expr_exthdr_get(const struct nftnl_expr *e, uint16_t type,
77  uint32_t *data_len)
78 {
79  struct nftnl_expr_exthdr *exthdr = nftnl_expr_data(e);
80 
81  switch(type) {
82  case NFTNL_EXPR_EXTHDR_DREG:
83  *data_len = sizeof(exthdr->dreg);
84  return &exthdr->dreg;
85  case NFTNL_EXPR_EXTHDR_TYPE:
86  *data_len = sizeof(exthdr->type);
87  return &exthdr->type;
88  case NFTNL_EXPR_EXTHDR_OFFSET:
89  *data_len = sizeof(exthdr->offset);
90  return &exthdr->offset;
91  case NFTNL_EXPR_EXTHDR_LEN:
92  *data_len = sizeof(exthdr->len);
93  return &exthdr->len;
94  case NFTNL_EXPR_EXTHDR_OP:
95  *data_len = sizeof(exthdr->op);
96  return &exthdr->op;
97  case NFTNL_EXPR_EXTHDR_FLAGS:
98  *data_len = sizeof(exthdr->flags);
99  return &exthdr->flags;
100  case NFTNL_EXPR_EXTHDR_SREG:
101  *data_len = sizeof(exthdr->sreg);
102  return &exthdr->sreg;
103  }
104  return NULL;
105 }
106 
107 static int nftnl_expr_exthdr_cb(const struct nlattr *attr, void *data)
108 {
109  const struct nlattr **tb = data;
110  int type = mnl_attr_get_type(attr);
111 
112  if (mnl_attr_type_valid(attr, NFTA_EXTHDR_MAX) < 0)
113  return MNL_CB_OK;
114 
115  switch(type) {
116  case NFTA_EXTHDR_TYPE:
117  if (mnl_attr_validate(attr, MNL_TYPE_U8) < 0)
118  abi_breakage();
119  break;
120  case NFTA_EXTHDR_DREG:
121  case NFTA_EXTHDR_SREG:
122  case NFTA_EXTHDR_OFFSET:
123  case NFTA_EXTHDR_LEN:
124  case NFTA_EXTHDR_OP:
125  case NFTA_EXTHDR_FLAGS:
126  if (mnl_attr_validate(attr, MNL_TYPE_U32) < 0)
127  abi_breakage();
128  break;
129  }
130 
131  tb[type] = attr;
132  return MNL_CB_OK;
133 }
134 
135 static void
136 nftnl_expr_exthdr_build(struct nlmsghdr *nlh, const struct nftnl_expr *e)
137 {
138  struct nftnl_expr_exthdr *exthdr = nftnl_expr_data(e);
139 
140  if (e->flags & (1 << NFTNL_EXPR_EXTHDR_DREG))
141  mnl_attr_put_u32(nlh, NFTA_EXTHDR_DREG, htonl(exthdr->dreg));
142  if (e->flags & (1 << NFTNL_EXPR_EXTHDR_SREG))
143  mnl_attr_put_u32(nlh, NFTA_EXTHDR_SREG, htonl(exthdr->sreg));
144  if (e->flags & (1 << NFTNL_EXPR_EXTHDR_TYPE))
145  mnl_attr_put_u8(nlh, NFTA_EXTHDR_TYPE, exthdr->type);
146  if (e->flags & (1 << NFTNL_EXPR_EXTHDR_OFFSET))
147  mnl_attr_put_u32(nlh, NFTA_EXTHDR_OFFSET, htonl(exthdr->offset));
148  if (e->flags & (1 << NFTNL_EXPR_EXTHDR_LEN))
149  mnl_attr_put_u32(nlh, NFTA_EXTHDR_LEN, htonl(exthdr->len));
150  if (e->flags & (1 << NFTNL_EXPR_EXTHDR_OP))
151  mnl_attr_put_u32(nlh, NFTA_EXTHDR_OP, htonl(exthdr->op));
152  if (e->flags & (1 << NFTNL_EXPR_EXTHDR_FLAGS))
153  mnl_attr_put_u32(nlh, NFTA_EXTHDR_FLAGS, htonl(exthdr->flags));
154 }
155 
156 static int
157 nftnl_expr_exthdr_parse(struct nftnl_expr *e, struct nlattr *attr)
158 {
159  struct nftnl_expr_exthdr *exthdr = nftnl_expr_data(e);
160  struct nlattr *tb[NFTA_EXTHDR_MAX+1] = {};
161 
162  if (mnl_attr_parse_nested(attr, nftnl_expr_exthdr_cb, tb) < 0)
163  return -1;
164 
165  if (tb[NFTA_EXTHDR_DREG]) {
166  exthdr->dreg = ntohl(mnl_attr_get_u32(tb[NFTA_EXTHDR_DREG]));
167  e->flags |= (1 << NFTNL_EXPR_EXTHDR_DREG);
168  }
169  if (tb[NFTA_EXTHDR_SREG]) {
170  exthdr->sreg = ntohl(mnl_attr_get_u32(tb[NFTA_EXTHDR_SREG]));
171  e->flags |= (1 << NFTNL_EXPR_EXTHDR_SREG);
172  }
173  if (tb[NFTA_EXTHDR_TYPE]) {
174  exthdr->type = mnl_attr_get_u8(tb[NFTA_EXTHDR_TYPE]);
175  e->flags |= (1 << NFTNL_EXPR_EXTHDR_TYPE);
176  }
177  if (tb[NFTA_EXTHDR_OFFSET]) {
178  exthdr->offset = ntohl(mnl_attr_get_u32(tb[NFTA_EXTHDR_OFFSET]));
179  e->flags |= (1 << NFTNL_EXPR_EXTHDR_OFFSET);
180  }
181  if (tb[NFTA_EXTHDR_LEN]) {
182  exthdr->len = ntohl(mnl_attr_get_u32(tb[NFTA_EXTHDR_LEN]));
183  e->flags |= (1 << NFTNL_EXPR_EXTHDR_LEN);
184  }
185  if (tb[NFTA_EXTHDR_OP]) {
186  exthdr->op = ntohl(mnl_attr_get_u32(tb[NFTA_EXTHDR_OP]));
187  e->flags |= (1 << NFTNL_EXPR_EXTHDR_OP);
188  }
189  if (tb[NFTA_EXTHDR_FLAGS]) {
190  exthdr->flags = ntohl(mnl_attr_get_u32(tb[NFTA_EXTHDR_FLAGS]));
191  e->flags |= (1 << NFTNL_EXPR_EXTHDR_FLAGS);
192  }
193 
194  return 0;
195 }
196 
197 static const char *op2str(uint8_t op)
198 {
199  switch (op) {
200  case NFT_EXTHDR_OP_TCPOPT:
201  return " tcpopt";
202  case NFT_EXTHDR_OP_IPV6:
203  default:
204  return "";
205  }
206 }
207 
208 static const char *type2str(uint32_t type)
209 {
210  switch (type) {
211  case IPPROTO_HOPOPTS:
212  return "hopopts";
213  case IPPROTO_ROUTING:
214  return "routing";
215  case IPPROTO_FRAGMENT:
216  return "fragment";
217  case IPPROTO_DSTOPTS:
218  return "dstopts";
219  case IPPROTO_MH:
220  return "mh";
221  default:
222  return "unknown";
223  }
224 }
225 
226 static inline int str2exthdr_op(const char* str)
227 {
228  if (!strcmp(str, "tcpopt"))
229  return NFT_EXTHDR_OP_TCPOPT;
230 
231  /* if str == "ipv6" or anything else */
232  return NFT_EXTHDR_OP_IPV6;
233 }
234 
235 static inline int str2exthdr_type(const char *str)
236 {
237  if (strcmp(str, "hopopts") == 0)
238  return IPPROTO_HOPOPTS;
239  else if (strcmp(str, "routing") == 0)
240  return IPPROTO_ROUTING;
241  else if (strcmp(str, "fragment") == 0)
242  return IPPROTO_FRAGMENT;
243  else if (strcmp(str, "dstopts") == 0)
244  return IPPROTO_DSTOPTS;
245  else if (strcmp(str, "mh") == 0)
246  return IPPROTO_MH;
247 
248  return -1;
249 }
250 
251 static int
252 nftnl_expr_exthdr_json_parse(struct nftnl_expr *e, json_t *root,
253  struct nftnl_parse_err *err)
254 {
255 #ifdef JSON_PARSING
256  const char *exthdr_type;
257  uint32_t uval32;
258  int type;
259 
260  if (nftnl_jansson_parse_reg(root, "dreg", NFTNL_TYPE_U32, &uval32,
261  err) == 0)
262  nftnl_expr_set_u32(e, NFTNL_EXPR_EXTHDR_DREG, uval32);
263 
264  if (nftnl_jansson_parse_reg(root, "sreg", NFTNL_TYPE_U32, &uval32,
265  err) == 0)
266  nftnl_expr_set_u32(e, NFTNL_EXPR_EXTHDR_SREG, uval32);
267 
268  exthdr_type = nftnl_jansson_parse_str(root, "exthdr_type", err);
269  if (exthdr_type != NULL) {
270  type = str2exthdr_type(exthdr_type);
271  if (type < 0)
272  return -1;
273  nftnl_expr_set_u32(e, NFTNL_EXPR_EXTHDR_TYPE, type);
274  }
275 
276  if (nftnl_jansson_parse_val(root, "offset", NFTNL_TYPE_U32, &uval32,
277  err) == 0)
278  nftnl_expr_set_u32(e, NFTNL_EXPR_EXTHDR_OFFSET, uval32);
279 
280  if (nftnl_jansson_parse_val(root, "len", NFTNL_TYPE_U32, &uval32, err) == 0)
281  nftnl_expr_set_u32(e, NFTNL_EXPR_EXTHDR_LEN, uval32);
282 
283  if (nftnl_jansson_parse_val(root, "op", NFTNL_TYPE_U32, &uval32, err) == 0)
284  nftnl_expr_set_u32(e, NFTNL_EXPR_EXTHDR_OP, uval32);
285 
286  if (nftnl_jansson_parse_val(root, "flags", NFTNL_TYPE_U32, &uval32, err) == 0)
287  nftnl_expr_set_u32(e, NFTNL_EXPR_EXTHDR_FLAGS, uval32);
288 
289  return 0;
290 #else
291  errno = EOPNOTSUPP;
292  return -1;
293 #endif
294 }
295 
296 static int nftnl_expr_exthdr_export(char *buf, size_t len,
297  const struct nftnl_expr *e, int type)
298 {
299  struct nftnl_expr_exthdr *exthdr = nftnl_expr_data(e);
300  NFTNL_BUF_INIT(b, buf, len);
301 
302  if (e->flags & (1 << NFTNL_EXPR_EXTHDR_DREG))
303  nftnl_buf_u32(&b, type, exthdr->dreg, DREG);
304  if (e->flags & (1 << NFTNL_EXPR_EXTHDR_SREG))
305  nftnl_buf_u32(&b, type, exthdr->dreg, SREG);
306  if (e->flags & (1 << NFTNL_EXPR_EXTHDR_TYPE))
307  nftnl_buf_str(&b, type, type2str(exthdr->type), EXTHDR_TYPE);
308  if (e->flags & (1 << NFTNL_EXPR_EXTHDR_OFFSET))
309  nftnl_buf_u32(&b, type, exthdr->offset, OFFSET);
310  if (e->flags & (1 << NFTNL_EXPR_EXTHDR_LEN))
311  nftnl_buf_u32(&b, type, exthdr->len, LEN);
312  if (e->flags & (1 << NFTNL_EXPR_EXTHDR_OP))
313  nftnl_buf_u32(&b, type, exthdr->op, OP);
314  if (e->flags & (1 << NFTNL_EXPR_EXTHDR_FLAGS))
315  nftnl_buf_u32(&b, type, exthdr->flags, FLAGS);
316 
317  return nftnl_buf_done(&b);
318 }
319 
320 static int nftnl_expr_exthdr_snprintf_default(char *buf, size_t len,
321  const struct nftnl_expr *e)
322 {
323  struct nftnl_expr_exthdr *exthdr = nftnl_expr_data(e);
324 
325  if (e->flags & (1 << NFTNL_EXPR_EXTHDR_DREG))
326  return snprintf(buf, len, "load%s %ub @ %u + %u%s => reg %u ",
327  op2str(exthdr->op), exthdr->len, exthdr->type,
328  exthdr->offset,
329  exthdr->flags & NFT_EXTHDR_F_PRESENT ? " present" : "",
330  exthdr->dreg);
331  else
332  return snprintf(buf, len, "write%s reg %u => %ub @ %u + %u ",
333  op2str(exthdr->op), exthdr->sreg, exthdr->len, exthdr->type,
334  exthdr->offset);
335 
336 }
337 
338 static int
339 nftnl_expr_exthdr_snprintf(char *buf, size_t len, uint32_t type,
340  uint32_t flags, const struct nftnl_expr *e)
341 {
342  switch (type) {
343  case NFTNL_OUTPUT_DEFAULT:
344  return nftnl_expr_exthdr_snprintf_default(buf, len, e);
345  case NFTNL_OUTPUT_XML:
346  case NFTNL_OUTPUT_JSON:
347  return nftnl_expr_exthdr_export(buf, len, e, type);
348  default:
349  break;
350  }
351  return -1;
352 }
353 
354 static bool nftnl_expr_exthdr_cmp(const struct nftnl_expr *e1,
355  const struct nftnl_expr *e2)
356 {
357  struct nftnl_expr_exthdr *h1 = nftnl_expr_data(e1);
358  struct nftnl_expr_exthdr *h2 = nftnl_expr_data(e2);
359  bool eq = true;
360 
361  if (e1->flags & (1 << NFTNL_EXPR_EXTHDR_DREG))
362  eq &= (h1->dreg == h2->dreg);
363  if (e1->flags & (1 << NFTNL_EXPR_EXTHDR_SREG))
364  eq &= (h1->sreg == h2->sreg);
365  if (e1->flags & (1 << NFTNL_EXPR_EXTHDR_OFFSET))
366  eq &= (h1->offset == h2->offset);
367  if (e1->flags & (1 << NFTNL_EXPR_EXTHDR_LEN))
368  eq &= (h1->len == h2->len);
369  if (e1->flags & (1 << NFTNL_EXPR_EXTHDR_TYPE))
370  eq &= (h1->type == h2->type);
371  if (e1->flags & (1 << NFTNL_EXPR_EXTHDR_OP))
372  eq &= (h1->op == h2->op);
373  if (e1->flags & (1 << NFTNL_EXPR_EXTHDR_FLAGS))
374  eq &= (h1->flags == h2->flags);
375 
376  return eq;
377 }
378 
379 struct expr_ops expr_ops_exthdr = {
380  .name = "exthdr",
381  .alloc_len = sizeof(struct nftnl_expr_exthdr),
382  .max_attr = NFTA_EXTHDR_MAX,
383  .cmp = nftnl_expr_exthdr_cmp,
384  .set = nftnl_expr_exthdr_set,
385  .get = nftnl_expr_exthdr_get,
386  .parse = nftnl_expr_exthdr_parse,
387  .build = nftnl_expr_exthdr_build,
388  .snprintf = nftnl_expr_exthdr_snprintf,
389  .json_parse = nftnl_expr_exthdr_json_parse,
390 };