16 #include <netinet/in.h>
17 #include <netinet/ip.h>
18 #include <netinet/tcp.h>
19 #include <arpa/inet.h>
20 #include <sys/types.h>
21 #include <sys/socket.h>
24 #include <linux/netfilter.h>
25 #include <linux/netfilter/nfnetlink.h>
26 #include <linux/netfilter/nf_tables.h>
28 #include <libmnl/libmnl.h>
29 #include <libnftnl/rule.h>
30 #include <libnftnl/expr.h>
32 static void add_payload(
struct nftnl_rule *r, uint32_t base, uint32_t dreg,
33 uint32_t offset, uint32_t len)
37 e = nftnl_expr_alloc(
"payload");
39 perror(
"expr payload oom");
43 nftnl_expr_set_u32(e, NFTNL_EXPR_PAYLOAD_BASE, base);
44 nftnl_expr_set_u32(e, NFTNL_EXPR_PAYLOAD_DREG, dreg);
45 nftnl_expr_set_u32(e, NFTNL_EXPR_PAYLOAD_OFFSET, offset);
46 nftnl_expr_set_u32(e, NFTNL_EXPR_PAYLOAD_LEN, len);
48 nftnl_rule_add_expr(r, e);
51 static void add_cmp(
struct nftnl_rule *r, uint32_t sreg, uint32_t op,
52 const void *data, uint32_t data_len)
56 e = nftnl_expr_alloc(
"cmp");
58 perror(
"expr cmp oom");
62 nftnl_expr_set_u32(e, NFTNL_EXPR_CMP_SREG, sreg);
63 nftnl_expr_set_u32(e, NFTNL_EXPR_CMP_OP, op);
64 nftnl_expr_set(e, NFTNL_EXPR_CMP_DATA, data, data_len);
66 nftnl_rule_add_expr(r, e);
73 e = nftnl_expr_alloc(
"counter");
75 perror(
"expr counter oom");
79 nftnl_rule_add_expr(r, e);
82 static struct nftnl_rule *setup_rule(uint8_t family,
const char *table,
83 const char *chain,
const char *handle)
90 r = nftnl_rule_alloc();
96 nftnl_rule_set(r, NFTNL_RULE_TABLE, table);
97 nftnl_rule_set(r, NFTNL_RULE_CHAIN, chain);
98 nftnl_rule_set_u32(r, NFTNL_RULE_FAMILY, family);
100 if (handle != NULL) {
101 handle_num = atoll(handle);
102 nftnl_rule_set_u64(r, NFTNL_RULE_POSITION, handle_num);
106 add_payload(r, NFT_PAYLOAD_NETWORK_HEADER, NFT_REG_1,
107 offsetof(
struct iphdr, protocol),
sizeof(uint8_t));
108 add_cmp(r, NFT_REG_1, NFT_CMP_EQ, &proto,
sizeof(uint8_t));
111 add_payload(r, NFT_PAYLOAD_TRANSPORT_HEADER, NFT_REG_1,
112 offsetof(
struct tcphdr, dest),
sizeof(uint16_t));
113 add_cmp(r, NFT_REG_1, NFT_CMP_EQ, &dport,
sizeof(uint16_t));
120 static void nftnl_mnl_batch_put(
char *buf, uint16_t type, uint32_t seq)
122 struct nlmsghdr *nlh;
123 struct nfgenmsg *nfg;
125 nlh = mnl_nlmsg_put_header(buf);
126 nlh->nlmsg_type = type;
127 nlh->nlmsg_flags = NLM_F_REQUEST;
128 nlh->nlmsg_seq = seq;
130 nfg = mnl_nlmsg_put_extra_header(nlh,
sizeof(*nfg));
131 nfg->nfgen_family = AF_INET;
132 nfg->version = NFNETLINK_V0;
133 nfg->res_id = NFNL_SUBSYS_NFTABLES;
136 int main(
int argc,
char *argv[])
138 struct mnl_socket *nl;
140 struct nlmsghdr *nlh;
141 struct mnl_nlmsg_batch *batch;
143 char buf[MNL_SOCKET_BUFFER_SIZE];
144 uint32_t seq = time(NULL);
147 if (argc < 4 || argc > 5) {
148 fprintf(stderr,
"Usage: %s <family> <table> <chain>\n", argv[0]);
152 if (strcmp(argv[1],
"ip") == 0)
153 family = NFPROTO_IPV4;
154 else if (strcmp(argv[1],
"ip6") == 0)
155 family = NFPROTO_IPV6;
157 fprintf(stderr,
"Unknown family: ip, ip6\n");
162 r = setup_rule(family, argv[2], argv[3], NULL);
164 r = setup_rule(family, argv[2], argv[3], argv[4]);
166 nl = mnl_socket_open(NETLINK_NETFILTER);
168 perror(
"mnl_socket_open");
172 if (mnl_socket_bind(nl, 0, MNL_SOCKET_AUTOPID) < 0) {
173 perror(
"mnl_socket_bind");
177 batch = mnl_nlmsg_batch_start(buf,
sizeof(buf));
179 nftnl_mnl_batch_put(mnl_nlmsg_batch_current(batch),
180 NFNL_MSG_BATCH_BEGIN, seq++);
181 mnl_nlmsg_batch_next(batch);
183 nlh = nftnl_rule_nlmsg_build_hdr(mnl_nlmsg_batch_current(batch),
185 nftnl_rule_get_u32(r, NFTNL_RULE_FAMILY),
186 NLM_F_APPEND|NLM_F_CREATE|NLM_F_ACK, seq++);
188 nftnl_rule_nlmsg_build_payload(nlh, r);
190 mnl_nlmsg_batch_next(batch);
192 nftnl_mnl_batch_put(mnl_nlmsg_batch_current(batch), NFNL_MSG_BATCH_END,
194 mnl_nlmsg_batch_next(batch);
196 ret = mnl_socket_sendto(nl, mnl_nlmsg_batch_head(batch),
197 mnl_nlmsg_batch_size(batch));
199 perror(
"mnl_socket_sendto");
203 mnl_nlmsg_batch_stop(batch);
205 ret = mnl_socket_recvfrom(nl, buf,
sizeof(buf));
207 perror(
"mnl_socket_recvfrom");
211 ret = mnl_cb_run(buf, ret, 0, mnl_socket_get_portid(nl), NULL, NULL);
213 perror(
"mnl_cb_run");
217 mnl_socket_close(nl);