libnftnl 1.2.9
payload.c
1/* SPDX-License-Identifier: GPL-2.0-or-later */
2/*
3 * (C) 2012 by Pablo Neira Ayuso <pablo@netfilter.org>
4 *
5 * This code has been sponsored by Sophos Astaro <http://www.sophos.com>
6 */
7
8#include "internal.h"
9
10#include <stdio.h>
11#include <stdint.h>
12#include <string.h>
13#include <limits.h>
14#include <arpa/inet.h>
15#include <errno.h>
16#include <libmnl/libmnl.h>
17
18#include <linux/netfilter/nf_tables.h>
19
20#include <libnftnl/expr.h>
21#include <libnftnl/rule.h>
22
24 enum nft_registers sreg;
25 enum nft_registers dreg;
26 enum nft_payload_bases base;
27 uint32_t offset;
28 uint32_t len;
29 uint32_t csum_type;
30 uint32_t csum_offset;
31 uint32_t csum_flags;
32};
33
34static int
35nftnl_expr_payload_set(struct nftnl_expr *e, uint16_t type,
36 const void *data, uint32_t data_len)
37{
38 struct nftnl_expr_payload *payload = nftnl_expr_data(e);
39
40 switch(type) {
41 case NFTNL_EXPR_PAYLOAD_SREG:
42 memcpy(&payload->sreg, data, data_len);
43 break;
44 case NFTNL_EXPR_PAYLOAD_DREG:
45 memcpy(&payload->dreg, data, data_len);
46 break;
47 case NFTNL_EXPR_PAYLOAD_BASE:
48 memcpy(&payload->base, data, data_len);
49 break;
50 case NFTNL_EXPR_PAYLOAD_OFFSET:
51 memcpy(&payload->offset, data, data_len);
52 break;
53 case NFTNL_EXPR_PAYLOAD_LEN:
54 memcpy(&payload->len, data, data_len);
55 break;
56 case NFTNL_EXPR_PAYLOAD_CSUM_TYPE:
57 memcpy(&payload->csum_type, data, data_len);
58 break;
59 case NFTNL_EXPR_PAYLOAD_CSUM_OFFSET:
60 memcpy(&payload->csum_offset, data, data_len);
61 break;
62 case NFTNL_EXPR_PAYLOAD_FLAGS:
63 memcpy(&payload->csum_flags, data, data_len);
64 break;
65 }
66 return 0;
67}
68
69static const void *
70nftnl_expr_payload_get(const struct nftnl_expr *e, uint16_t type,
71 uint32_t *data_len)
72{
73 struct nftnl_expr_payload *payload = nftnl_expr_data(e);
74
75 switch(type) {
76 case NFTNL_EXPR_PAYLOAD_SREG:
77 *data_len = sizeof(payload->sreg);
78 return &payload->sreg;
79 case NFTNL_EXPR_PAYLOAD_DREG:
80 *data_len = sizeof(payload->dreg);
81 return &payload->dreg;
82 case NFTNL_EXPR_PAYLOAD_BASE:
83 *data_len = sizeof(payload->base);
84 return &payload->base;
85 case NFTNL_EXPR_PAYLOAD_OFFSET:
86 *data_len = sizeof(payload->offset);
87 return &payload->offset;
88 case NFTNL_EXPR_PAYLOAD_LEN:
89 *data_len = sizeof(payload->len);
90 return &payload->len;
91 case NFTNL_EXPR_PAYLOAD_CSUM_TYPE:
92 *data_len = sizeof(payload->csum_type);
93 return &payload->csum_type;
94 case NFTNL_EXPR_PAYLOAD_CSUM_OFFSET:
95 *data_len = sizeof(payload->csum_offset);
96 return &payload->csum_offset;
97 case NFTNL_EXPR_PAYLOAD_FLAGS:
98 *data_len = sizeof(payload->csum_flags);
99 return &payload->csum_flags;
100 }
101 return NULL;
102}
103
104static int nftnl_expr_payload_cb(const struct nlattr *attr, void *data)
105{
106 const struct nlattr **tb = data;
107 int type = mnl_attr_get_type(attr);
108
109 if (mnl_attr_type_valid(attr, NFTA_PAYLOAD_MAX) < 0)
110 return MNL_CB_OK;
111
112 switch(type) {
113 case NFTA_PAYLOAD_SREG:
114 case NFTA_PAYLOAD_DREG:
115 case NFTA_PAYLOAD_BASE:
116 case NFTA_PAYLOAD_OFFSET:
117 case NFTA_PAYLOAD_LEN:
118 case NFTA_PAYLOAD_CSUM_TYPE:
119 case NFTA_PAYLOAD_CSUM_OFFSET:
120 case NFTA_PAYLOAD_CSUM_FLAGS:
121 if (mnl_attr_validate(attr, MNL_TYPE_U32) < 0)
122 abi_breakage();
123 break;
124 }
125
126 tb[type] = attr;
127 return MNL_CB_OK;
128}
129
130static void
131nftnl_expr_payload_build(struct nlmsghdr *nlh, const struct nftnl_expr *e)
132{
133 struct nftnl_expr_payload *payload = nftnl_expr_data(e);
134
135 if (e->flags & (1 << NFTNL_EXPR_PAYLOAD_SREG))
136 mnl_attr_put_u32(nlh, NFTA_PAYLOAD_SREG, htonl(payload->sreg));
137 if (e->flags & (1 << NFTNL_EXPR_PAYLOAD_DREG))
138 mnl_attr_put_u32(nlh, NFTA_PAYLOAD_DREG, htonl(payload->dreg));
139 if (e->flags & (1 << NFTNL_EXPR_PAYLOAD_BASE))
140 mnl_attr_put_u32(nlh, NFTA_PAYLOAD_BASE, htonl(payload->base));
141 if (e->flags & (1 << NFTNL_EXPR_PAYLOAD_OFFSET))
142 mnl_attr_put_u32(nlh, NFTA_PAYLOAD_OFFSET, htonl(payload->offset));
143 if (e->flags & (1 << NFTNL_EXPR_PAYLOAD_LEN))
144 mnl_attr_put_u32(nlh, NFTA_PAYLOAD_LEN, htonl(payload->len));
145 if (e->flags & (1 << NFTNL_EXPR_PAYLOAD_CSUM_TYPE))
146 mnl_attr_put_u32(nlh, NFTA_PAYLOAD_CSUM_TYPE,
147 htonl(payload->csum_type));
148 if (e->flags & (1 << NFTNL_EXPR_PAYLOAD_CSUM_OFFSET))
149 mnl_attr_put_u32(nlh, NFTA_PAYLOAD_CSUM_OFFSET,
150 htonl(payload->csum_offset));
151 if (e->flags & (1 << NFTNL_EXPR_PAYLOAD_FLAGS))
152 mnl_attr_put_u32(nlh, NFTA_PAYLOAD_CSUM_FLAGS,
153 htonl(payload->csum_flags));
154}
155
156static int
157nftnl_expr_payload_parse(struct nftnl_expr *e, struct nlattr *attr)
158{
159 struct nftnl_expr_payload *payload = nftnl_expr_data(e);
160 struct nlattr *tb[NFTA_PAYLOAD_MAX+1] = {};
161
162 if (mnl_attr_parse_nested(attr, nftnl_expr_payload_cb, tb) < 0)
163 return -1;
164
165 if (tb[NFTA_PAYLOAD_SREG]) {
166 payload->sreg = ntohl(mnl_attr_get_u32(tb[NFTA_PAYLOAD_SREG]));
167 e->flags |= (1 << NFTNL_EXPR_PAYLOAD_SREG);
168 }
169 if (tb[NFTA_PAYLOAD_DREG]) {
170 payload->dreg = ntohl(mnl_attr_get_u32(tb[NFTA_PAYLOAD_DREG]));
171 e->flags |= (1 << NFTNL_EXPR_PAYLOAD_DREG);
172 }
173 if (tb[NFTA_PAYLOAD_BASE]) {
174 payload->base = ntohl(mnl_attr_get_u32(tb[NFTA_PAYLOAD_BASE]));
175 e->flags |= (1 << NFTNL_EXPR_PAYLOAD_BASE);
176 }
177 if (tb[NFTA_PAYLOAD_OFFSET]) {
178 payload->offset = ntohl(mnl_attr_get_u32(tb[NFTA_PAYLOAD_OFFSET]));
179 e->flags |= (1 << NFTNL_EXPR_PAYLOAD_OFFSET);
180 }
181 if (tb[NFTA_PAYLOAD_LEN]) {
182 payload->len = ntohl(mnl_attr_get_u32(tb[NFTA_PAYLOAD_LEN]));
183 e->flags |= (1 << NFTNL_EXPR_PAYLOAD_LEN);
184 }
185 if (tb[NFTA_PAYLOAD_CSUM_TYPE]) {
186 payload->csum_type = ntohl(mnl_attr_get_u32(tb[NFTA_PAYLOAD_CSUM_TYPE]));
187 e->flags |= (1 << NFTNL_EXPR_PAYLOAD_CSUM_TYPE);
188 }
189 if (tb[NFTA_PAYLOAD_CSUM_OFFSET]) {
190 payload->csum_offset = ntohl(mnl_attr_get_u32(tb[NFTA_PAYLOAD_CSUM_OFFSET]));
191 e->flags |= (1 << NFTNL_EXPR_PAYLOAD_CSUM_OFFSET);
192 }
193 if (tb[NFTA_PAYLOAD_CSUM_FLAGS]) {
194 payload->csum_flags = ntohl(mnl_attr_get_u32(tb[NFTA_PAYLOAD_CSUM_FLAGS]));
195 e->flags |= (1 << NFTNL_EXPR_PAYLOAD_FLAGS);
196 }
197 return 0;
198}
199
200static const char *base2str_array[NFT_PAYLOAD_TUN_HEADER + 1] = {
201 [NFT_PAYLOAD_LL_HEADER] = "link",
202 [NFT_PAYLOAD_NETWORK_HEADER] = "network",
203 [NFT_PAYLOAD_TRANSPORT_HEADER] = "transport",
204 [NFT_PAYLOAD_INNER_HEADER] = "inner",
205 [NFT_PAYLOAD_TUN_HEADER] = "tunnel",
206};
207
208static const char *base2str(enum nft_payload_bases base)
209{
210 if (base >= array_size(base2str_array))
211 return "unknown";
212
213 return base2str_array[base];
214}
215
216static int
217nftnl_expr_payload_snprintf(char *buf, size_t len,
218 uint32_t flags, const struct nftnl_expr *e)
219{
220 struct nftnl_expr_payload *payload = nftnl_expr_data(e);
221
222 if (payload->sreg)
223 return snprintf(buf, len, "write reg %u => %ub @ %s header + %u csum_type %u csum_off %u csum_flags 0x%x ",
224 payload->sreg,
225 payload->len, base2str(payload->base),
226 payload->offset, payload->csum_type,
227 payload->csum_offset,
228 payload->csum_flags);
229 else
230 return snprintf(buf, len, "load %ub @ %s header + %u => reg %u ",
231 payload->len, base2str(payload->base),
232 payload->offset, payload->dreg);
233}
234
235static struct attr_policy payload_attr_policy[__NFTNL_EXPR_PAYLOAD_MAX] = {
236 [NFTNL_EXPR_PAYLOAD_DREG] = { .maxlen = sizeof(uint32_t) },
237 [NFTNL_EXPR_PAYLOAD_BASE] = { .maxlen = sizeof(uint32_t) },
238 [NFTNL_EXPR_PAYLOAD_OFFSET] = { .maxlen = sizeof(uint32_t) },
239 [NFTNL_EXPR_PAYLOAD_LEN] = { .maxlen = sizeof(uint32_t) },
240 [NFTNL_EXPR_PAYLOAD_SREG] = { .maxlen = sizeof(uint32_t) },
241 [NFTNL_EXPR_PAYLOAD_CSUM_TYPE] = { .maxlen = sizeof(uint32_t) },
242 [NFTNL_EXPR_PAYLOAD_CSUM_OFFSET] = { .maxlen = sizeof(uint32_t) },
243 [NFTNL_EXPR_PAYLOAD_FLAGS] = { .maxlen = sizeof(uint32_t) },
244};
245
246struct expr_ops expr_ops_payload = {
247 .name = "payload",
248 .alloc_len = sizeof(struct nftnl_expr_payload),
249 .nftnl_max_attr = __NFTNL_EXPR_PAYLOAD_MAX - 1,
250 .attr_policy = payload_attr_policy,
251 .set = nftnl_expr_payload_set,
252 .get = nftnl_expr_payload_get,
253 .parse = nftnl_expr_payload_parse,
254 .build = nftnl_expr_payload_build,
255 .output = nftnl_expr_payload_snprintf,
256};