18 #include <arpa/inet.h>
20 #include <libmnl/libmnl.h>
22 #include <linux/netfilter/nf_tables.h>
24 #include <libnftnl/expr.h>
25 #include <libnftnl/rule.h>
28 enum nft_registers sreg;
29 enum nft_registers dreg;
30 enum nft_payload_bases base;
39 nftnl_expr_payload_set(
struct nftnl_expr *e, uint16_t type,
40 const void *data, uint32_t data_len)
45 case NFTNL_EXPR_PAYLOAD_SREG:
46 payload->sreg = *((uint32_t *)data);
48 case NFTNL_EXPR_PAYLOAD_DREG:
49 payload->dreg = *((uint32_t *)data);
51 case NFTNL_EXPR_PAYLOAD_BASE:
52 payload->base = *((uint32_t *)data);
54 case NFTNL_EXPR_PAYLOAD_OFFSET:
55 payload->offset = *((
unsigned int *)data);
57 case NFTNL_EXPR_PAYLOAD_LEN:
58 payload->len = *((
unsigned int *)data);
60 case NFTNL_EXPR_PAYLOAD_CSUM_TYPE:
61 payload->csum_type = *((uint32_t *)data);
63 case NFTNL_EXPR_PAYLOAD_CSUM_OFFSET:
64 payload->csum_offset = *((uint32_t *)data);
66 case NFTNL_EXPR_PAYLOAD_FLAGS:
67 payload->csum_flags = *((uint32_t *)data);
76 nftnl_expr_payload_get(
const struct nftnl_expr *e, uint16_t type,
82 case NFTNL_EXPR_PAYLOAD_SREG:
83 *data_len =
sizeof(payload->sreg);
84 return &payload->sreg;
85 case NFTNL_EXPR_PAYLOAD_DREG:
86 *data_len =
sizeof(payload->dreg);
87 return &payload->dreg;
88 case NFTNL_EXPR_PAYLOAD_BASE:
89 *data_len =
sizeof(payload->base);
90 return &payload->base;
91 case NFTNL_EXPR_PAYLOAD_OFFSET:
92 *data_len =
sizeof(payload->offset);
93 return &payload->offset;
94 case NFTNL_EXPR_PAYLOAD_LEN:
95 *data_len =
sizeof(payload->len);
97 case NFTNL_EXPR_PAYLOAD_CSUM_TYPE:
98 *data_len =
sizeof(payload->csum_type);
99 return &payload->csum_type;
100 case NFTNL_EXPR_PAYLOAD_CSUM_OFFSET:
101 *data_len =
sizeof(payload->csum_offset);
102 return &payload->csum_offset;
103 case NFTNL_EXPR_PAYLOAD_FLAGS:
104 *data_len =
sizeof(payload->csum_flags);
105 return &payload->csum_flags;
110 static int nftnl_expr_payload_cb(
const struct nlattr *attr,
void *data)
112 const struct nlattr **tb = data;
113 int type = mnl_attr_get_type(attr);
115 if (mnl_attr_type_valid(attr, NFTA_PAYLOAD_MAX) < 0)
119 case NFTA_PAYLOAD_SREG:
120 case NFTA_PAYLOAD_DREG:
121 case NFTA_PAYLOAD_BASE:
122 case NFTA_PAYLOAD_OFFSET:
123 case NFTA_PAYLOAD_LEN:
124 case NFTA_PAYLOAD_CSUM_TYPE:
125 case NFTA_PAYLOAD_CSUM_OFFSET:
126 case NFTA_PAYLOAD_CSUM_FLAGS:
127 if (mnl_attr_validate(attr, MNL_TYPE_U32) < 0)
137 nftnl_expr_payload_build(
struct nlmsghdr *nlh,
const struct nftnl_expr *e)
141 if (e->flags & (1 << NFTNL_EXPR_PAYLOAD_SREG))
142 mnl_attr_put_u32(nlh, NFTA_PAYLOAD_SREG, htonl(payload->sreg));
143 if (e->flags & (1 << NFTNL_EXPR_PAYLOAD_DREG))
144 mnl_attr_put_u32(nlh, NFTA_PAYLOAD_DREG, htonl(payload->dreg));
145 if (e->flags & (1 << NFTNL_EXPR_PAYLOAD_BASE))
146 mnl_attr_put_u32(nlh, NFTA_PAYLOAD_BASE, htonl(payload->base));
147 if (e->flags & (1 << NFTNL_EXPR_PAYLOAD_OFFSET))
148 mnl_attr_put_u32(nlh, NFTA_PAYLOAD_OFFSET, htonl(payload->offset));
149 if (e->flags & (1 << NFTNL_EXPR_PAYLOAD_LEN))
150 mnl_attr_put_u32(nlh, NFTA_PAYLOAD_LEN, htonl(payload->len));
151 if (e->flags & (1 << NFTNL_EXPR_PAYLOAD_CSUM_TYPE))
152 mnl_attr_put_u32(nlh, NFTA_PAYLOAD_CSUM_TYPE,
153 htonl(payload->csum_type));
154 if (e->flags & (1 << NFTNL_EXPR_PAYLOAD_CSUM_OFFSET))
155 mnl_attr_put_u32(nlh, NFTA_PAYLOAD_CSUM_OFFSET,
156 htonl(payload->csum_offset));
157 if (e->flags & (1 << NFTNL_EXPR_PAYLOAD_FLAGS))
158 mnl_attr_put_u32(nlh, NFTA_PAYLOAD_CSUM_FLAGS,
159 htonl(payload->csum_flags));
163 nftnl_expr_payload_parse(
struct nftnl_expr *e,
struct nlattr *attr)
166 struct nlattr *tb[NFTA_PAYLOAD_MAX+1] = {};
168 if (mnl_attr_parse_nested(attr, nftnl_expr_payload_cb, tb) < 0)
171 if (tb[NFTA_PAYLOAD_SREG]) {
172 payload->sreg = ntohl(mnl_attr_get_u32(tb[NFTA_PAYLOAD_SREG]));
173 e->flags |= (1 << NFTNL_EXPR_PAYLOAD_SREG);
175 if (tb[NFTA_PAYLOAD_DREG]) {
176 payload->dreg = ntohl(mnl_attr_get_u32(tb[NFTA_PAYLOAD_DREG]));
177 e->flags |= (1 << NFTNL_EXPR_PAYLOAD_DREG);
179 if (tb[NFTA_PAYLOAD_BASE]) {
180 payload->base = ntohl(mnl_attr_get_u32(tb[NFTA_PAYLOAD_BASE]));
181 e->flags |= (1 << NFTNL_EXPR_PAYLOAD_BASE);
183 if (tb[NFTA_PAYLOAD_OFFSET]) {
184 payload->offset = ntohl(mnl_attr_get_u32(tb[NFTA_PAYLOAD_OFFSET]));
185 e->flags |= (1 << NFTNL_EXPR_PAYLOAD_OFFSET);
187 if (tb[NFTA_PAYLOAD_LEN]) {
188 payload->len = ntohl(mnl_attr_get_u32(tb[NFTA_PAYLOAD_LEN]));
189 e->flags |= (1 << NFTNL_EXPR_PAYLOAD_LEN);
191 if (tb[NFTA_PAYLOAD_CSUM_TYPE]) {
192 payload->csum_type = ntohl(mnl_attr_get_u32(tb[NFTA_PAYLOAD_CSUM_TYPE]));
193 e->flags |= (1 << NFTNL_EXPR_PAYLOAD_CSUM_TYPE);
195 if (tb[NFTA_PAYLOAD_CSUM_OFFSET]) {
196 payload->csum_offset = ntohl(mnl_attr_get_u32(tb[NFTA_PAYLOAD_CSUM_OFFSET]));
197 e->flags |= (1 << NFTNL_EXPR_PAYLOAD_CSUM_OFFSET);
199 if (tb[NFTA_PAYLOAD_CSUM_FLAGS]) {
200 payload->csum_flags = ntohl(mnl_attr_get_u32(tb[NFTA_PAYLOAD_CSUM_FLAGS]));
201 e->flags |= (1 << NFTNL_EXPR_PAYLOAD_FLAGS);
206 static const char *base2str_array[NFT_PAYLOAD_TRANSPORT_HEADER+1] = {
207 [NFT_PAYLOAD_LL_HEADER] =
"link",
208 [NFT_PAYLOAD_NETWORK_HEADER] =
"network",
209 [NFT_PAYLOAD_TRANSPORT_HEADER] =
"transport",
212 static const char *base2str(
enum nft_payload_bases base)
214 if (base > NFT_PAYLOAD_TRANSPORT_HEADER)
217 return base2str_array[base];
220 static inline int nftnl_str2base(
const char *base)
222 if (strcmp(base,
"link") == 0)
223 return NFT_PAYLOAD_LL_HEADER;
224 else if (strcmp(base,
"network") == 0)
225 return NFT_PAYLOAD_NETWORK_HEADER;
226 else if (strcmp(base,
"transport") == 0)
227 return NFT_PAYLOAD_TRANSPORT_HEADER;
235 nftnl_expr_payload_json_parse(
struct nftnl_expr *e, json_t *root,
236 struct nftnl_parse_err *err)
239 const char *base_str;
240 uint32_t reg, uval32;
243 if (nftnl_jansson_parse_reg(root,
"dreg", NFTNL_TYPE_U32, ®, err) == 0)
244 nftnl_expr_set_u32(e, NFTNL_EXPR_PAYLOAD_DREG, reg);
246 base_str = nftnl_jansson_parse_str(root,
"base", err);
247 if (base_str != NULL) {
248 base = nftnl_str2base(base_str);
252 nftnl_expr_set_u32(e, NFTNL_EXPR_PAYLOAD_BASE, base);
255 if (nftnl_jansson_parse_val(root,
"offset", NFTNL_TYPE_U32, &uval32,
257 nftnl_expr_set_u32(e, NFTNL_EXPR_PAYLOAD_OFFSET, uval32);
259 if (nftnl_jansson_parse_val(root,
"len", NFTNL_TYPE_U32, &uval32, err) == 0)
260 nftnl_expr_set_u32(e, NFTNL_EXPR_PAYLOAD_LEN, uval32);
269 static int nftnl_expr_payload_export(
char *buf,
size_t size, uint32_t flags,
270 const struct nftnl_expr *e,
int type)
273 NFTNL_BUF_INIT(b, buf, size);
275 if (e->flags & (1 << NFTNL_EXPR_PAYLOAD_DREG))
276 nftnl_buf_u32(&b, type, payload->dreg, DREG);
277 if (e->flags & (1 << NFTNL_EXPR_PAYLOAD_OFFSET))
278 nftnl_buf_u32(&b, type, payload->offset, OFFSET);
279 if (e->flags & (1 << NFTNL_EXPR_PAYLOAD_LEN))
280 nftnl_buf_u32(&b, type, payload->len, LEN);
281 if (e->flags & (1 << NFTNL_EXPR_PAYLOAD_BASE))
282 nftnl_buf_str(&b, type, base2str(payload->base), BASE);
284 return nftnl_buf_done(&b);
288 nftnl_expr_payload_snprintf(
char *buf,
size_t len, uint32_t type,
289 uint32_t flags,
const struct nftnl_expr *e)
294 case NFTNL_OUTPUT_DEFAULT:
296 return snprintf(buf, len,
"write reg %u => %ub @ %s header + %u csum_type %u csum_off %u csum_flags 0x%x ",
298 payload->len, base2str(payload->base),
299 payload->offset, payload->csum_type,
300 payload->csum_offset,
301 payload->csum_flags);
303 return snprintf(buf, len,
"load %ub @ %s header + %u => reg %u ",
304 payload->len, base2str(payload->base),
305 payload->offset, payload->dreg);
306 case NFTNL_OUTPUT_XML:
307 case NFTNL_OUTPUT_JSON:
308 return nftnl_expr_payload_export(buf, len, flags, e, type);
315 static bool nftnl_expr_payload_cmp(
const struct nftnl_expr *e1,
316 const struct nftnl_expr *e2)
322 if (e1->flags & (1 << NFTNL_EXPR_PAYLOAD_SREG))
323 eq &= (p1->sreg == p2->sreg);
324 if (e1->flags & (1 << NFTNL_EXPR_PAYLOAD_DREG))
325 eq &= (p1->dreg == p2->dreg);
326 if (e1->flags & (1 << NFTNL_EXPR_PAYLOAD_BASE))
327 eq &= (p1->base == p2->base);
328 if (e1->flags & (1 << NFTNL_EXPR_PAYLOAD_OFFSET))
329 eq &= (p1->offset == p2->offset);
330 if (e1->flags & (1 << NFTNL_EXPR_PAYLOAD_LEN))
331 eq &= (p1->len == p2->len);
332 if (e1->flags & (1 << NFTNL_EXPR_PAYLOAD_CSUM_TYPE))
333 eq &= (p1->csum_type == p2->csum_type);
334 if (e1->flags & (1 << NFTNL_EXPR_PAYLOAD_CSUM_OFFSET))
335 eq &= (p1->csum_offset == p2->csum_offset);
336 if (e1->flags & (1 << NFTNL_EXPR_PAYLOAD_FLAGS))
337 eq &= (p1->csum_flags == p2->csum_flags);
342 struct expr_ops expr_ops_payload = {
345 .max_attr = NFTA_PAYLOAD_MAX,
346 .cmp = nftnl_expr_payload_cmp,
347 .set = nftnl_expr_payload_set,
348 .get = nftnl_expr_payload_get,
349 .parse = nftnl_expr_payload_parse,
350 .build = nftnl_expr_payload_build,
351 .snprintf = nftnl_expr_payload_snprintf,
352 .json_parse = nftnl_expr_payload_json_parse,