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