2 * Copyright (c) 2008 Patrick McHardy <kaber@trash.net>
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License version 2 as
6 * published by the Free Software Foundation.
8 * Development of this code funded by Astaro AG (http://www.astaro.com/)
11 #include <linux/kernel.h>
12 #include <linux/module.h>
13 #include <linux/init.h>
14 #include <linux/list.h>
15 #include <linux/rculist.h>
16 #include <linux/skbuff.h>
17 #include <linux/netlink.h>
18 #include <linux/netfilter.h>
19 #include <linux/static_key.h>
20 #include <linux/netfilter/nfnetlink.h>
21 #include <linux/netfilter/nf_tables.h>
22 #include <net/netfilter/nf_tables_core.h>
23 #include <net/netfilter/nf_tables.h>
24 #include <net/netfilter/nf_log.h>
26 static noinline void __nft_trace_packet(struct nft_traceinfo *info,
27 const struct nft_chain *chain,
28 enum nft_trace_types type)
30 const struct nft_pktinfo *pkt = info->pkt;
32 if (!info->trace || !pkt->skb->nf_trace)
38 nft_trace_notify(info);
41 static inline void nft_trace_packet(struct nft_traceinfo *info,
42 const struct nft_chain *chain,
43 const struct nft_rule *rule,
44 enum nft_trace_types type)
46 if (static_branch_unlikely(&nft_trace_enabled)) {
48 __nft_trace_packet(info, chain, type);
52 static void nft_cmp_fast_eval(const struct nft_expr *expr,
53 struct nft_regs *regs)
55 const struct nft_cmp_fast_expr *priv = nft_expr_priv(expr);
56 u32 mask = nft_cmp_fast_mask(priv->len);
58 if ((regs->data[priv->sreg] & mask) == priv->data)
60 regs->verdict.code = NFT_BREAK;
63 static bool nft_payload_fast_eval(const struct nft_expr *expr,
64 struct nft_regs *regs,
65 const struct nft_pktinfo *pkt)
67 const struct nft_payload *priv = nft_expr_priv(expr);
68 const struct sk_buff *skb = pkt->skb;
69 u32 *dest = ®s->data[priv->dreg];
72 if (priv->base == NFT_PAYLOAD_NETWORK_HEADER)
73 ptr = skb_network_header(skb);
77 ptr = skb_network_header(skb) + pkt->xt.thoff;
82 if (unlikely(ptr + priv->len > skb_tail_pointer(skb)))
87 *(u16 *)dest = *(u16 *)ptr;
88 else if (priv->len == 4)
89 *(u32 *)dest = *(u32 *)ptr;
91 *(u8 *)dest = *(u8 *)ptr;
95 DEFINE_STATIC_KEY_FALSE(nft_counters_enabled);
97 static noinline void nft_update_chain_stats(const struct nft_chain *chain,
98 const struct nft_pktinfo *pkt)
100 struct nft_base_chain *base_chain;
101 struct nft_stats __percpu *pstats;
102 struct nft_stats *stats;
104 base_chain = nft_base_chain(chain);
107 pstats = READ_ONCE(base_chain->stats);
110 stats = this_cpu_ptr(pstats);
111 u64_stats_update_begin(&stats->syncp);
113 stats->bytes += pkt->skb->len;
114 u64_stats_update_end(&stats->syncp);
120 struct nft_jumpstack {
121 const struct nft_chain *chain;
122 struct nft_rule *const *rules;
125 static void expr_call_ops_eval(const struct nft_expr *expr,
126 struct nft_regs *regs,
127 struct nft_pktinfo *pkt)
129 unsigned long e = (unsigned long)expr->ops->eval;
131 if (e == (unsigned long)nft_meta_get_eval)
132 nft_meta_get_eval(expr, regs, pkt);
133 else if (e == (unsigned long)nft_lookup_eval)
134 nft_lookup_eval(expr, regs, pkt);
136 expr->ops->eval(expr, regs, pkt);
140 nft_do_chain(struct nft_pktinfo *pkt, void *priv)
142 const struct nft_chain *chain = priv, *basechain = chain;
143 const struct net *net = nft_net(pkt);
144 struct nft_rule *const *rules;
145 const struct nft_rule *rule;
146 const struct nft_expr *expr, *last;
147 struct nft_regs regs;
148 unsigned int stackptr = 0;
149 struct nft_jumpstack jumpstack[NFT_JUMP_STACK_SIZE];
150 bool genbit = READ_ONCE(net->nft.gencursor);
151 struct nft_traceinfo info;
154 if (static_branch_unlikely(&nft_trace_enabled))
155 nft_trace_init(&info, pkt, ®s.verdict, basechain);
158 rules = rcu_dereference(chain->rules_gen_1);
160 rules = rcu_dereference(chain->rules_gen_0);
164 regs.verdict.code = NFT_CONTINUE;
165 for (; *rules ; rules++) {
167 nft_rule_for_each_expr(expr, last, rule) {
168 if (expr->ops == &nft_cmp_fast_ops)
169 nft_cmp_fast_eval(expr, ®s);
170 else if (expr->ops != &nft_payload_fast_ops ||
171 !nft_payload_fast_eval(expr, ®s, pkt))
172 expr_call_ops_eval(expr, ®s, pkt);
174 if (regs.verdict.code != NFT_CONTINUE)
178 switch (regs.verdict.code) {
180 regs.verdict.code = NFT_CONTINUE;
183 nft_trace_packet(&info, chain, rule,
190 switch (regs.verdict.code & NF_VERDICT_MASK) {
195 nft_trace_packet(&info, chain, rule,
197 return regs.verdict.code;
200 switch (regs.verdict.code) {
202 if (WARN_ON_ONCE(stackptr >= NFT_JUMP_STACK_SIZE))
204 jumpstack[stackptr].chain = chain;
205 jumpstack[stackptr].rules = rules + 1;
209 nft_trace_packet(&info, chain, rule,
212 chain = regs.verdict.chain;
217 nft_trace_packet(&info, chain, rule,
218 NFT_TRACETYPE_RETURN);
226 chain = jumpstack[stackptr].chain;
227 rules = jumpstack[stackptr].rules;
231 nft_trace_packet(&info, basechain, NULL, NFT_TRACETYPE_POLICY);
233 if (static_branch_unlikely(&nft_counters_enabled))
234 nft_update_chain_stats(basechain, pkt);
236 return nft_base_chain(basechain)->policy;
238 EXPORT_SYMBOL_GPL(nft_do_chain);
240 static struct nft_expr_type *nft_basic_types[] = {
254 int __init nf_tables_core_module_init(void)
258 for (i = 0; i < ARRAY_SIZE(nft_basic_types); i++) {
259 err = nft_register_expr(nft_basic_types[i]);
268 nft_unregister_expr(nft_basic_types[i]);
272 void nf_tables_core_module_exit(void)
276 i = ARRAY_SIZE(nft_basic_types);
278 nft_unregister_expr(nft_basic_types[i]);