1 /*
2 * Copyright (c) 2008-2009 Patrick McHardy <kaber@trash.net>
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 version 2 as
6 * published by the Free Software Foundation.
7 *
8 * Development of this code funded by Astaro AG (http://www.astaro.com/)
9 */
10
11 #include <linux/kernel.h>
12 #include <linux/init.h>
13 #include <linux/module.h>
14 #include <linux/netlink.h>
15 #include <linux/netfilter.h>
16 #include <linux/netfilter/nf_tables.h>
17 #include <linux/in.h>
18 #include <linux/ip.h>
19 #include <linux/ipv6.h>
20 #include <linux/smp.h>
21 #include <linux/static_key.h>
22 #include <net/dst.h>
23 #include <net/sock.h>
24 #include <net/tcp_states.h> /* for TCP_TIME_WAIT */
25 #include <net/netfilter/nf_tables.h>
26 #include <net/netfilter/nf_tables_core.h>
27 #include <net/netfilter/nft_meta.h>
28
29 #include <uapi/linux/netfilter_bridge.h> /* NF_BR_PRE_ROUTING */
30
31 static DEFINE_PER_CPU(struct rnd_state, nft_prandom_state);
32
33 void nft_meta_get_eval(const struct nft_expr *expr,
34 struct nft_regs *regs,
35 const struct nft_pktinfo *pkt)
36 {
37 const struct nft_meta *priv = nft_expr_priv(expr);
38 const struct sk_buff *skb = pkt->skb;
39 const struct net_device *in = nft_in(pkt), *out = nft_out(pkt);
40 struct sock *sk;
41 u32 *dest = ®s->data[priv->dreg];
42
43 switch (priv->key) {
44 case NFT_META_LEN:
45 *dest = skb->len;
46 break;
47 case NFT_META_PROTOCOL:
48 nft_reg_store16(dest, (__force u16)skb->protocol);
49 break;
50 case NFT_META_NFPROTO:
51 nft_reg_store8(dest, nft_pf(pkt));
52 break;
53 case NFT_META_L4PROTO:
54 if (!pkt->tprot_set)
55 goto err;
56 nft_reg_store8(dest, pkt->tprot);
57 break;
58 case NFT_META_PRIORITY:
59 *dest = skb->priority;
60 break;
61 case NFT_META_MARK:
62 *dest = skb->mark;
63 break;
64 case NFT_META_IIF:
65 if (in == NULL)
66 goto err;
67 *dest = in->ifindex;
68 break;
69 case NFT_META_OIF:
70 if (out == NULL)
71 goto err;
72 *dest = out->ifindex;
73 break;
74 case NFT_META_IIFNAME:
75 if (in == NULL)
76 goto err;
77 strncpy((char *)dest, in->name, IFNAMSIZ);
78 break;
79 case NFT_META_OIFNAME:
80 if (out == NULL)
81 goto err;
82 strncpy((char *)dest, out->name, IFNAMSIZ);
83 break;
84 case NFT_META_IIFTYPE:
85 if (in == NULL)
86 goto err;
87 nft_reg_store16(dest, in->type);
88 break;
89 case NFT_META_OIFTYPE:
90 if (out == NULL)
91 goto err;
92 nft_reg_store16(dest, out->type);
93 break;
94 case NFT_META_SKUID:
95 sk = skb_to_full_sk(skb);
96 if (!sk || !sk_fullsock(sk))
97 goto err;
98
99 read_lock_bh(&sk->sk_callback_lock);
100 if (sk->sk_socket == NULL ||
101 sk->sk_socket->file == NULL) {
102 read_unlock_bh(&sk->sk_callback_lock);
103 goto err;
104 }
105
106 *dest = from_kuid_munged(&init_user_ns,
107 sk->sk_socket->file->f_cred->fsuid);
108 read_unlock_bh(&sk->sk_callback_lock);
109 break;
110 case NFT_META_SKGID:
111 sk = skb_to_full_sk(skb);
112 if (!sk || !sk_fullsock(sk))
113 goto err;
114
115 read_lock_bh(&sk->sk_callback_lock);
116 if (sk->sk_socket == NULL ||
117 sk->sk_socket->file == NULL) {
118 read_unlock_bh(&sk->sk_callback_lock);
119 goto err;
120 }
121 *dest = from_kgid_munged(&init_user_ns,
122 sk->sk_socket->file->f_cred->fsgid);
123 read_unlock_bh(&sk->sk_callback_lock);
124 break;
125 #ifdef CONFIG_IP_ROUTE_CLASSID
126 case NFT_META_RTCLASSID: {
127 const struct dst_entry *dst = skb_dst(skb);
128
129 if (dst == NULL)
130 goto err;
131 *dest = dst->tclassid;
132 break;
133 }
134 #endif
135 #ifdef CONFIG_NETWORK_SECMARK
136 case NFT_META_SECMARK:
137 *dest = skb->secmark;
138 break;
139 #endif
140 case NFT_META_PKTTYPE:
141 if (skb->pkt_type != PACKET_LOOPBACK) {
142 nft_reg_store8(dest, skb->pkt_type);
143 break;
144 }
145
146 switch (nft_pf(pkt)) {
147 case NFPROTO_IPV4:
148 if (ipv4_is_multicast(ip_hdr(skb)->daddr))
149 nft_reg_store8(dest, PACKET_MULTICAST);
150 else
151 nft_reg_store8(dest, PACKET_BROADCAST);
152 break;
153 case NFPROTO_IPV6:
154 nft_reg_store8(dest, PACKET_MULTICAST);
155 break;
156 case NFPROTO_NETDEV:
157 switch (skb->protocol) {
158 case htons(ETH_P_IP): {
159 int noff = skb_network_offset(skb);
160 struct iphdr *iph, _iph;
161
162 iph = skb_header_pointer(skb, noff,
163 sizeof(_iph), &_iph);
164 if (!iph)
165 goto err;
166
167 if (ipv4_is_multicast(iph->daddr))
168 nft_reg_store8(dest, PACKET_MULTICAST);
169 else
170 nft_reg_store8(dest, PACKET_BROADCAST);
171
172 break;
173 }
174 case htons(ETH_P_IPV6):
175 nft_reg_store8(dest, PACKET_MULTICAST);
176 break;
177 default:
178 WARN_ON_ONCE(1);
179 goto err;
180 }
181 break;
182 default:
183 WARN_ON_ONCE(1);
184 goto err;
185 }
186 break;
187 case NFT_META_CPU:
188 *dest = raw_smp_processor_id();
189 break;
190 case NFT_META_IIFGROUP:
191 if (in == NULL)
192 goto err;
193 *dest = in->group;
194 break;
195 case NFT_META_OIFGROUP:
196 if (out == NULL)
197 goto err;
198 *dest = out->group;
199 break;
200 #ifdef CONFIG_CGROUP_NET_CLASSID
201 case NFT_META_CGROUP:
202 sk = skb_to_full_sk(skb);
203 if (!sk || !sk_fullsock(sk))
204 goto err;
205 *dest = sock_cgroup_classid(&sk->sk_cgrp_data);
206 break;
207 #endif
208 case NFT_META_PRANDOM: {
209 struct rnd_state *state = this_cpu_ptr(&nft_prandom_state);
210 *dest = prandom_u32_state(state);
211 break;
212 }
213 #ifdef CONFIG_XFRM
214 case NFT_META_SECPATH:
215 nft_reg_store8(dest, !!skb->sp);
216 break;
217 #endif
218 default:
219 WARN_ON(1);
220 goto err;
221 }
222 return;
223
224 err:
225 regs->verdict.code = NFT_BREAK;
226 }
227 EXPORT_SYMBOL_GPL(nft_meta_get_eval);
228
229 void nft_meta_set_eval(const struct nft_expr *expr,
230 struct nft_regs *regs,
231 const struct nft_pktinfo *pkt)
232 {
233 const struct nft_meta *meta = nft_expr_priv(expr);
234 struct sk_buff *skb = pkt->skb;
235 u32 *sreg = ®s->data[meta->sreg];
236 u32 value = *sreg;
237 u8 pkt_type;
238
239 switch (meta->key) {
240 case NFT_META_MARK:
241 skb->mark = value;
242 break;
243 case NFT_META_PRIORITY:
244 skb->priority = value;
245 break;
246 case NFT_META_PKTTYPE:
247 pkt_type = nft_reg_load8(sreg);
248
249 if (skb->pkt_type != pkt_type &&
250 skb_pkt_type_ok(pkt_type) &&
251 skb_pkt_type_ok(skb->pkt_type))
252 skb->pkt_type = pkt_type;
253 break;
254 case NFT_META_NFTRACE:
255 skb->nf_trace = !!value;
256 break;
257 default:
258 WARN_ON(1);
259 }
260 }
261 EXPORT_SYMBOL_GPL(nft_meta_set_eval);
262
263 const struct nla_policy nft_meta_policy[NFTA_META_MAX + 1] = {
264 [NFTA_META_DREG] = { .type = NLA_U32 },
265 [NFTA_META_KEY] = { .type = NLA_U32 },
266 [NFTA_META_SREG] = { .type = NLA_U32 },
267 };
268 EXPORT_SYMBOL_GPL(nft_meta_policy);
269
270 int nft_meta_get_init(const struct nft_ctx *ctx,
271 const struct nft_expr *expr,
272 const struct nlattr * const tb[])
273 {
274 struct nft_meta *priv = nft_expr_priv(expr);
275 unsigned int len;
276
277 priv->key = ntohl(nla_get_be32(tb[NFTA_META_KEY]));
278 switch (priv->key) {
279 case NFT_META_PROTOCOL:
280 case NFT_META_IIFTYPE:
281 case NFT_META_OIFTYPE:
282 len = sizeof(u16);
283 break;
284 case NFT_META_NFPROTO:
285 case NFT_META_L4PROTO:
286 case NFT_META_LEN:
287 case NFT_META_PRIORITY:
288 case NFT_META_MARK:
289 case NFT_META_IIF:
290 case NFT_META_OIF:
291 case NFT_META_SKUID:
292 case NFT_META_SKGID:
293 #ifdef CONFIG_IP_ROUTE_CLASSID
294 case NFT_META_RTCLASSID:
295 #endif
296 #ifdef CONFIG_NETWORK_SECMARK
297 case NFT_META_SECMARK:
298 #endif
299 case NFT_META_PKTTYPE:
300 case NFT_META_CPU:
301 case NFT_META_IIFGROUP:
302 case NFT_META_OIFGROUP:
303 #ifdef CONFIG_CGROUP_NET_CLASSID
304 case NFT_META_CGROUP:
305 #endif
306 len = sizeof(u32);
307 break;
308 case NFT_META_IIFNAME:
309 case NFT_META_OIFNAME:
310 len = IFNAMSIZ;
311 break;
312 case NFT_META_PRANDOM:
313 prandom_init_once(&nft_prandom_state);
314 len = sizeof(u32);
315 break;
316 #ifdef CONFIG_XFRM
317 case NFT_META_SECPATH:
318 len = sizeof(u8);
319 break;
320 #endif
321 default:
322 return -EOPNOTSUPP;
323 }
324
325 priv->dreg = nft_parse_register(tb[NFTA_META_DREG]);
326 return nft_validate_register_store(ctx, priv->dreg, NULL,
327 NFT_DATA_VALUE, len);
328 }
329 EXPORT_SYMBOL_GPL(nft_meta_get_init);
330
331 static int nft_meta_get_validate(const struct nft_ctx *ctx,
332 const struct nft_expr *expr,
333 const struct nft_data **data)
334 {
335 #ifdef CONFIG_XFRM
336 const struct nft_meta *priv = nft_expr_priv(expr);
337 unsigned int hooks;
338
339 if (priv->key != NFT_META_SECPATH)
340 return 0;
341
342 switch (ctx->family) {
343 case NFPROTO_NETDEV:
344 hooks = 1 << NF_NETDEV_INGRESS;
345 break;
346 case NFPROTO_IPV4:
347 case NFPROTO_IPV6:
348 case NFPROTO_INET:
349 hooks = (1 << NF_INET_PRE_ROUTING) |
350 (1 << NF_INET_LOCAL_IN) |
351 (1 << NF_INET_FORWARD);
352 break;
353 default:
354 return -EOPNOTSUPP;
355 }
356
357 return nft_chain_validate_hooks(ctx->chain, hooks);
358 #else
359 return 0;
360 #endif
361 }
362
363 int nft_meta_set_validate(const struct nft_ctx *ctx,
364 const struct nft_expr *expr,
365 const struct nft_data **data)
366 {
367 struct nft_meta *priv = nft_expr_priv(expr);
368 unsigned int hooks;
369
370 if (priv->key != NFT_META_PKTTYPE)
371 return 0;
372
373 switch (ctx->family) {
374 case NFPROTO_BRIDGE:
375 hooks = 1 << NF_BR_PRE_ROUTING;
376 break;
377 case NFPROTO_NETDEV:
378 hooks = 1 << NF_NETDEV_INGRESS;
379 break;
380 case NFPROTO_IPV4:
381 case NFPROTO_IPV6:
382 case NFPROTO_INET:
383 hooks = 1 << NF_INET_PRE_ROUTING;
384 break;
385 default:
386 return -EOPNOTSUPP;
387 }
388
389 return nft_chain_validate_hooks(ctx->chain, hooks);
390 }
391 EXPORT_SYMBOL_GPL(nft_meta_set_validate);
392
393 int nft_meta_set_init(const struct nft_ctx *ctx,
394 const struct nft_expr *expr,
395 const struct nlattr * const tb[])
396 {
397 struct nft_meta *priv = nft_expr_priv(expr);
398 unsigned int len;
399 int err;
400
401 priv->key = ntohl(nla_get_be32(tb[NFTA_META_KEY]));
402 switch (priv->key) {
403 case NFT_META_MARK:
404 case NFT_META_PRIORITY:
405 len = sizeof(u32);
406 break;
407 case NFT_META_NFTRACE:
408 len = sizeof(u8);
409 break;
410 case NFT_META_PKTTYPE:
411 len = sizeof(u8);
412 break;
413 default:
414 return -EOPNOTSUPP;
415 }
416
417 priv->sreg = nft_parse_register(tb[NFTA_META_SREG]);
418 err = nft_validate_register_load(priv->sreg, len);
419 if (err < 0)
420 return err;
421
422 if (priv->key == NFT_META_NFTRACE)
423 static_branch_inc(&nft_trace_enabled);
424
425 return 0;
426 }
427 EXPORT_SYMBOL_GPL(nft_meta_set_init);
428
429 int nft_meta_get_dump(struct sk_buff *skb,
430 const struct nft_expr *expr)
431 {
432 const struct nft_meta *priv = nft_expr_priv(expr);
433
434 if (nla_put_be32(skb, NFTA_META_KEY, htonl(priv->key)))
435 goto nla_put_failure;
436 if (nft_dump_register(skb, NFTA_META_DREG, priv->dreg))
437 goto nla_put_failure;
438 return 0;
439
440 nla_put_failure:
441 return -1;
442 }
443 EXPORT_SYMBOL_GPL(nft_meta_get_dump);
444
445 int nft_meta_set_dump(struct sk_buff *skb,
446 const struct nft_expr *expr)
447 {
448 const struct nft_meta *priv = nft_expr_priv(expr);
449
450 if (nla_put_be32(skb, NFTA_META_KEY, htonl(priv->key)))
451 goto nla_put_failure;
452 if (nft_dump_register(skb, NFTA_META_SREG, priv->sreg))
453 goto nla_put_failure;
454
455 return 0;
456
457 nla_put_failure:
458 return -1;
459 }
460 EXPORT_SYMBOL_GPL(nft_meta_set_dump);
461
462 void nft_meta_set_destroy(const struct nft_ctx *ctx,
463 const struct nft_expr *expr)
464 {
465 const struct nft_meta *priv = nft_expr_priv(expr);
466
467 if (priv->key == NFT_META_NFTRACE)
468 static_branch_dec(&nft_trace_enabled);
469 }
470 EXPORT_SYMBOL_GPL(nft_meta_set_destroy);
471
472 static struct nft_expr_type nft_meta_type;
473 static const struct nft_expr_ops nft_meta_get_ops = {
474 .type = &nft_meta_type,
475 .size = NFT_EXPR_SIZE(sizeof(struct nft_meta)),
476 .eval = nft_meta_get_eval,
477 .init = nft_meta_get_init,
478 .dump = nft_meta_get_dump,
479 .validate = nft_meta_get_validate,
480 };
481
482 static const struct nft_expr_ops nft_meta_set_ops = {
483 .type = &nft_meta_type,
484 .size = NFT_EXPR_SIZE(sizeof(struct nft_meta)),
485 .eval = nft_meta_set_eval,
486 .init = nft_meta_set_init,
487 .destroy = nft_meta_set_destroy,
488 .dump = nft_meta_set_dump,
489 .validate = nft_meta_set_validate,
490 };
491
492 static const struct nft_expr_ops *
493 nft_meta_select_ops(const struct nft_ctx *ctx,
494 const struct nlattr * const tb[])
495 {
496 if (tb[NFTA_META_KEY] == NULL)
497 return ERR_PTR(-EINVAL);
498
499 if (tb[NFTA_META_DREG] && tb[NFTA_META_SREG])
500 return ERR_PTR(-EINVAL);
501
502 if (tb[NFTA_META_DREG])
503 return &nft_meta_get_ops;
504
505 if (tb[NFTA_META_SREG])
506 return &nft_meta_set_ops;
507
508 return ERR_PTR(-EINVAL);
509 }
510
511 static struct nft_expr_type nft_meta_type __read_mostly = {
512 .name = "meta",
513 .select_ops = nft_meta_select_ops,
514 .policy = nft_meta_policy,
515 .maxattr = NFTA_META_MAX,
516 .owner = THIS_MODULE,
517 };
518
519 static int __init nft_meta_module_init(void)
520 {
521 return nft_register_expr(&nft_meta_type);
522 }
523
524 static void __exit nft_meta_module_exit(void)
525 {
526 nft_unregister_expr(&nft_meta_type);
527 }
528
529 module_init(nft_meta_module_init);
530 module_exit(nft_meta_module_exit);
531
532 MODULE_LICENSE("GPL");
533 MODULE_AUTHOR("Patrick McHardy <kaber@trash.net>");
534 MODULE_ALIAS_NFT_EXPR("meta");
535
Linux® is a registered trademark of Linus Torvalds in the United States and other countries.
TOMOYO® is a registered trademark of NTT DATA CORPORATION.