14 #include <netinet/in.h>
16 #include <libmnl/libmnl.h>
17 #include <linux/netfilter.h>
18 #include <linux/netfilter/nfnetlink.h>
19 #include <linux/netfilter/nf_tables.h>
21 #include <libnftnl/trace.h>
51 EXPORT_SYMBOL(nftnl_trace_alloc);
57 EXPORT_SYMBOL(nftnl_trace_free);
62 xfree(t->jump_target);
69 EXPORT_SYMBOL(nftnl_trace_is_set);
70 bool nftnl_trace_is_set(
const struct nftnl_trace *t, uint16_t attr)
72 return t->flags & (1 << attr);
75 static int nftnl_trace_parse_attr_cb(
const struct nlattr *attr,
void *data)
77 const struct nlattr **tb = data;
78 enum nft_trace_attributes type = mnl_attr_get_type(attr);
80 if (mnl_attr_type_valid(attr, NFTA_TRACE_MAX) < 0)
84 case NFTA_TRACE_UNSPEC:
85 case __NFTA_TRACE_MAX:
87 case NFTA_TRACE_VERDICT:
88 if (mnl_attr_validate(attr, MNL_TYPE_NESTED) < 0)
91 case NFTA_TRACE_IIFTYPE:
92 case NFTA_TRACE_OIFTYPE:
93 if (mnl_attr_validate(attr, MNL_TYPE_U16) < 0)
100 case NFTA_TRACE_POLICY:
101 case NFTA_TRACE_NFPROTO:
102 case NFTA_TRACE_TYPE:
103 if (mnl_attr_validate(attr, MNL_TYPE_U32) < 0)
106 case NFTA_TRACE_CHAIN:
107 case NFTA_TRACE_TABLE:
108 if (mnl_attr_validate(attr, MNL_TYPE_STRING) < 0)
111 case NFTA_TRACE_RULE_HANDLE:
112 if (mnl_attr_validate(attr, MNL_TYPE_U64) < 0)
115 case NFTA_TRACE_LL_HEADER:
116 case NFTA_TRACE_NETWORK_HEADER:
117 case NFTA_TRACE_TRANSPORT_HEADER:
118 if (mnl_attr_get_payload_len(attr) == 0)
129 EXPORT_SYMBOL(nftnl_trace_get_data);
130 const void *nftnl_trace_get_data(
const struct nftnl_trace *trace,
131 uint16_t type, uint32_t *data_len)
133 enum nftnl_trace_attr attr = type;
135 if (!(trace->flags & (1 << type)))
139 case NFTNL_TRACE_FAMILY:
140 *data_len =
sizeof(uint32_t);
141 return &trace->family;
143 *data_len =
sizeof(uint32_t);
145 case NFTNL_TRACE_IIF:
146 *data_len =
sizeof(uint32_t);
148 case NFTNL_TRACE_OIF:
149 *data_len =
sizeof(uint32_t);
151 case NFTNL_TRACE_LL_HEADER:
152 *data_len = trace->ll.len;
153 return trace->ll.data;
154 case NFTNL_TRACE_MARK:
155 *data_len =
sizeof(uint32_t);
157 case NFTNL_TRACE_NETWORK_HEADER:
158 *data_len = trace->nh.len;
159 return trace->nh.data;
160 case NFTNL_TRACE_TYPE:
161 *data_len =
sizeof(uint32_t);
163 case NFTNL_TRACE_CHAIN:
164 *data_len = strlen(trace->chain) + 1;
166 case NFTNL_TRACE_TABLE:
167 *data_len = strlen(trace->table) + 1;
169 case NFTNL_TRACE_JUMP_TARGET:
170 *data_len = strlen(trace->jump_target) + 1;
171 return trace->jump_target;
172 case NFTNL_TRACE_TRANSPORT_HEADER:
173 *data_len = trace->th.len;
174 return trace->th.data;
175 case NFTNL_TRACE_RULE_HANDLE:
176 *data_len =
sizeof(uint64_t);
177 return &trace->rule_handle;
178 case NFTNL_TRACE_VERDICT:
179 *data_len =
sizeof(uint32_t);
180 return &trace->verdict;
181 case NFTNL_TRACE_IIFTYPE:
182 *data_len =
sizeof(uint16_t);
183 return &trace->iiftype;
184 case NFTNL_TRACE_OIFTYPE:
185 *data_len =
sizeof(uint16_t);
186 return &trace->oiftype;
187 case NFTNL_TRACE_NFPROTO:
188 *data_len =
sizeof(uint32_t);
189 return &trace->nfproto;
190 case NFTNL_TRACE_POLICY:
191 *data_len =
sizeof(uint32_t);
192 return &trace->policy;
193 case __NFTNL_TRACE_MAX:
200 EXPORT_SYMBOL(nftnl_trace_get_str);
201 const char *nftnl_trace_get_str(
const struct nftnl_trace *trace, uint16_t type)
203 if (!nftnl_trace_is_set(trace, type))
207 case NFTNL_TRACE_CHAIN:
return trace->chain;
208 case NFTNL_TRACE_TABLE:
return trace->table;
209 case NFTNL_TRACE_JUMP_TARGET:
return trace->jump_target;
215 EXPORT_SYMBOL(nftnl_trace_get_u16);
216 uint16_t nftnl_trace_get_u16(
const struct nftnl_trace *trace, uint16_t type)
221 d = nftnl_trace_get_data(trace, type, &dlen);
222 if (d && dlen ==
sizeof(*d))
228 EXPORT_SYMBOL(nftnl_trace_get_u32);
229 uint32_t nftnl_trace_get_u32(
const struct nftnl_trace *trace, uint16_t type)
234 d = nftnl_trace_get_data(trace, type, &dlen);
235 if (d && dlen ==
sizeof(*d))
241 EXPORT_SYMBOL(nftnl_trace_get_u64);
242 uint64_t nftnl_trace_get_u64(
const struct nftnl_trace *trace, uint16_t type)
247 d = nftnl_trace_get_data(trace, type, &dlen);
248 if (d && dlen ==
sizeof(*d))
254 static bool nftnl_trace_nlmsg_parse_hdrdata(
struct nlattr *attr,
262 len = mnl_attr_get_payload_len(attr);
264 header->data = malloc(len);
266 memcpy(header->data, mnl_attr_get_payload(attr), len);
274 static int nftnl_trace_parse_verdict_cb(
const struct nlattr *attr,
void *data)
276 int type = mnl_attr_get_type(attr);
277 const struct nlattr **tb = data;
280 case NFTA_VERDICT_CODE:
281 if (mnl_attr_validate(attr, MNL_TYPE_U32) < 0)
285 case NFTA_VERDICT_CHAIN:
286 if (mnl_attr_validate(attr, MNL_TYPE_STRING) < 0)
295 static int nftnl_trace_parse_verdict(
const struct nlattr *attr,
298 struct nlattr *tb[NFTA_VERDICT_MAX+1];
300 if (mnl_attr_parse_nested(attr, nftnl_trace_parse_verdict_cb, tb) < 0)
303 if (!tb[NFTA_VERDICT_CODE])
306 t->verdict = ntohl(mnl_attr_get_u32(tb[NFTA_VERDICT_CODE]));
307 t->flags |= (1 << NFTNL_TRACE_VERDICT);
309 switch (t->verdict) {
312 if (!tb[NFTA_VERDICT_CHAIN])
314 t->jump_target = strdup(mnl_attr_get_str(tb[NFTA_VERDICT_CHAIN]));
318 t->flags |= (1 << NFTNL_TRACE_JUMP_TARGET);
324 EXPORT_SYMBOL(nftnl_trace_nlmsg_parse);
325 int nftnl_trace_nlmsg_parse(
const struct nlmsghdr *nlh,
struct nftnl_trace *t)
327 struct nfgenmsg *nfg = mnl_nlmsg_get_payload(nlh);
328 struct nlattr *tb[NFTA_TRACE_MAX+1] = {};
330 if (mnl_attr_parse(nlh,
sizeof(*nfg), nftnl_trace_parse_attr_cb, tb) < 0)
333 if (!tb[NFTA_TRACE_ID])
336 if (!tb[NFTA_TRACE_TYPE])
339 t->family = nfg->nfgen_family;
340 t->flags |= (1 << NFTNL_TRACE_FAMILY);
342 t->type = ntohl(mnl_attr_get_u32(tb[NFTA_TRACE_TYPE]));
343 t->flags |= (1 << NFTNL_TRACE_TYPE);
345 t->id = ntohl(mnl_attr_get_u32(tb[NFTA_TRACE_ID]));
346 t->flags |= (1 << NFTNL_TRACE_ID);
348 if (tb[NFTA_TRACE_TABLE]) {
349 t->table = strdup(mnl_attr_get_str(tb[NFTA_TRACE_TABLE]));
353 t->flags |= (1 << NFTNL_TRACE_TABLE);
356 if (tb[NFTA_TRACE_CHAIN]) {
357 t->chain = strdup(mnl_attr_get_str(tb[NFTA_TRACE_CHAIN]));
361 t->flags |= (1 << NFTNL_TRACE_CHAIN);
364 if (tb[NFTA_TRACE_IIFTYPE]) {
365 t->iiftype = ntohs(mnl_attr_get_u16(tb[NFTA_TRACE_IIFTYPE]));
366 t->flags |= (1 << NFTNL_TRACE_IIFTYPE);
369 if (tb[NFTA_TRACE_IIF]) {
370 t->iif = ntohl(mnl_attr_get_u32(tb[NFTA_TRACE_IIF]));
371 t->flags |= (1 << NFTNL_TRACE_IIF);
374 if (tb[NFTA_TRACE_OIFTYPE]) {
375 t->oiftype = ntohs(mnl_attr_get_u16(tb[NFTA_TRACE_OIFTYPE]));
376 t->flags |= (1 << NFTNL_TRACE_OIFTYPE);
379 if (tb[NFTA_TRACE_OIF]) {
380 t->oif = ntohl(mnl_attr_get_u32(tb[NFTA_TRACE_OIF]));
381 t->flags |= (1 << NFTNL_TRACE_OIF);
384 if (tb[NFTA_TRACE_MARK]) {
385 t->mark = ntohl(mnl_attr_get_u32(tb[NFTA_TRACE_MARK]));
386 t->flags |= (1 << NFTNL_TRACE_MARK);
389 if (tb[NFTA_TRACE_RULE_HANDLE]) {
390 t->rule_handle = be64toh(mnl_attr_get_u64(tb[NFTA_TRACE_RULE_HANDLE]));
391 t->flags |= (1 << NFTNL_TRACE_RULE_HANDLE);
394 if (tb[NFTA_TRACE_VERDICT] &&
395 nftnl_trace_parse_verdict(tb[NFTA_TRACE_VERDICT], t) < 0)
398 if (nftnl_trace_nlmsg_parse_hdrdata(tb[NFTA_TRACE_LL_HEADER], &t->ll))
399 t->flags |= (1 << NFTNL_TRACE_LL_HEADER);
401 if (nftnl_trace_nlmsg_parse_hdrdata(tb[NFTA_TRACE_NETWORK_HEADER], &t->nh))
402 t->flags |= (1 << NFTNL_TRACE_NETWORK_HEADER);
404 if (nftnl_trace_nlmsg_parse_hdrdata(tb[NFTA_TRACE_TRANSPORT_HEADER], &t->th))
405 t->flags |= (1 << NFTNL_TRACE_TRANSPORT_HEADER);
407 if (tb[NFTA_TRACE_NFPROTO]) {
408 t->nfproto = ntohl(mnl_attr_get_u32(tb[NFTA_TRACE_NFPROTO]));
409 t->flags |= (1 << NFTNL_TRACE_NFPROTO);
412 if (tb[NFTA_TRACE_POLICY]) {
413 t->policy = ntohl(mnl_attr_get_u32(tb[NFTA_TRACE_POLICY]));
414 t->flags |= (1 << NFTNL_TRACE_POLICY);
417 if (tb[NFTA_TRACE_MARK]) {
418 t->mark = ntohl(mnl_attr_get_u32(tb[NFTA_TRACE_MARK]));
419 t->flags |= (1 << NFTNL_TRACE_MARK);