Loading...
1// SPDX-License-Identifier: GPL-2.0-only
2/*
3 * Copyright (c) 2008-2009 Patrick McHardy <kaber@trash.net>
4 * Copyright (c) 2014 Intel Corporation
5 * Author: Tomasz Bursztyka <tomasz.bursztyka@linux.intel.com>
6 *
7 * Development of this code funded by Astaro AG (http://www.astaro.com/)
8 */
9
10#include <linux/kernel.h>
11#include <linux/netlink.h>
12#include <linux/netfilter.h>
13#include <linux/netfilter/nf_tables.h>
14#include <linux/in.h>
15#include <linux/ip.h>
16#include <linux/ipv6.h>
17#include <linux/smp.h>
18#include <linux/static_key.h>
19#include <net/dst.h>
20#include <net/ip.h>
21#include <net/sock.h>
22#include <net/tcp_states.h> /* for TCP_TIME_WAIT */
23#include <net/netfilter/nf_tables.h>
24#include <net/netfilter/nf_tables_core.h>
25#include <net/netfilter/nft_meta.h>
26#include <net/netfilter/nf_tables_offload.h>
27
28#include <uapi/linux/netfilter_bridge.h> /* NF_BR_PRE_ROUTING */
29
30#define NFT_META_SECS_PER_MINUTE 60
31#define NFT_META_SECS_PER_HOUR 3600
32#define NFT_META_SECS_PER_DAY 86400
33#define NFT_META_DAYS_PER_WEEK 7
34
35static DEFINE_PER_CPU(struct rnd_state, nft_prandom_state);
36
37static u8 nft_meta_weekday(void)
38{
39 time64_t secs = ktime_get_real_seconds();
40 unsigned int dse;
41 u8 wday;
42
43 secs -= NFT_META_SECS_PER_MINUTE * sys_tz.tz_minuteswest;
44 dse = div_u64(secs, NFT_META_SECS_PER_DAY);
45 wday = (4 + dse) % NFT_META_DAYS_PER_WEEK;
46
47 return wday;
48}
49
50static u32 nft_meta_hour(time64_t secs)
51{
52 struct tm tm;
53
54 time64_to_tm(secs, 0, &tm);
55
56 return tm.tm_hour * NFT_META_SECS_PER_HOUR
57 + tm.tm_min * NFT_META_SECS_PER_MINUTE
58 + tm.tm_sec;
59}
60
61static noinline_for_stack void
62nft_meta_get_eval_time(enum nft_meta_keys key,
63 u32 *dest)
64{
65 switch (key) {
66 case NFT_META_TIME_NS:
67 nft_reg_store64(dest, ktime_get_real_ns());
68 break;
69 case NFT_META_TIME_DAY:
70 nft_reg_store8(dest, nft_meta_weekday());
71 break;
72 case NFT_META_TIME_HOUR:
73 *dest = nft_meta_hour(ktime_get_real_seconds());
74 break;
75 default:
76 break;
77 }
78}
79
80static noinline bool
81nft_meta_get_eval_pkttype_lo(const struct nft_pktinfo *pkt,
82 u32 *dest)
83{
84 const struct sk_buff *skb = pkt->skb;
85
86 switch (nft_pf(pkt)) {
87 case NFPROTO_IPV4:
88 if (ipv4_is_multicast(ip_hdr(skb)->daddr))
89 nft_reg_store8(dest, PACKET_MULTICAST);
90 else
91 nft_reg_store8(dest, PACKET_BROADCAST);
92 break;
93 case NFPROTO_IPV6:
94 nft_reg_store8(dest, PACKET_MULTICAST);
95 break;
96 case NFPROTO_NETDEV:
97 switch (skb->protocol) {
98 case htons(ETH_P_IP): {
99 int noff = skb_network_offset(skb);
100 struct iphdr *iph, _iph;
101
102 iph = skb_header_pointer(skb, noff,
103 sizeof(_iph), &_iph);
104 if (!iph)
105 return false;
106
107 if (ipv4_is_multicast(iph->daddr))
108 nft_reg_store8(dest, PACKET_MULTICAST);
109 else
110 nft_reg_store8(dest, PACKET_BROADCAST);
111
112 break;
113 }
114 case htons(ETH_P_IPV6):
115 nft_reg_store8(dest, PACKET_MULTICAST);
116 break;
117 default:
118 WARN_ON_ONCE(1);
119 return false;
120 }
121 break;
122 default:
123 WARN_ON_ONCE(1);
124 return false;
125 }
126
127 return true;
128}
129
130static noinline bool
131nft_meta_get_eval_skugid(enum nft_meta_keys key,
132 u32 *dest,
133 const struct nft_pktinfo *pkt)
134{
135 struct sock *sk = skb_to_full_sk(pkt->skb);
136 struct socket *sock;
137
138 if (!sk || !sk_fullsock(sk) || !net_eq(nft_net(pkt), sock_net(sk)))
139 return false;
140
141 read_lock_bh(&sk->sk_callback_lock);
142 sock = sk->sk_socket;
143 if (!sock || !sock->file) {
144 read_unlock_bh(&sk->sk_callback_lock);
145 return false;
146 }
147
148 switch (key) {
149 case NFT_META_SKUID:
150 *dest = from_kuid_munged(sock_net(sk)->user_ns,
151 sock->file->f_cred->fsuid);
152 break;
153 case NFT_META_SKGID:
154 *dest = from_kgid_munged(sock_net(sk)->user_ns,
155 sock->file->f_cred->fsgid);
156 break;
157 default:
158 break;
159 }
160
161 read_unlock_bh(&sk->sk_callback_lock);
162 return true;
163}
164
165#ifdef CONFIG_CGROUP_NET_CLASSID
166static noinline bool
167nft_meta_get_eval_cgroup(u32 *dest, const struct nft_pktinfo *pkt)
168{
169 struct sock *sk = skb_to_full_sk(pkt->skb);
170
171 if (!sk || !sk_fullsock(sk) || !net_eq(nft_net(pkt), sock_net(sk)))
172 return false;
173
174 *dest = sock_cgroup_classid(&sk->sk_cgrp_data);
175 return true;
176}
177#endif
178
179static noinline bool nft_meta_get_eval_kind(enum nft_meta_keys key,
180 u32 *dest,
181 const struct nft_pktinfo *pkt)
182{
183 const struct net_device *in = nft_in(pkt), *out = nft_out(pkt);
184
185 switch (key) {
186 case NFT_META_IIFKIND:
187 if (!in || !in->rtnl_link_ops)
188 return false;
189 strncpy((char *)dest, in->rtnl_link_ops->kind, IFNAMSIZ);
190 break;
191 case NFT_META_OIFKIND:
192 if (!out || !out->rtnl_link_ops)
193 return false;
194 strncpy((char *)dest, out->rtnl_link_ops->kind, IFNAMSIZ);
195 break;
196 default:
197 return false;
198 }
199
200 return true;
201}
202
203static void nft_meta_store_ifindex(u32 *dest, const struct net_device *dev)
204{
205 *dest = dev ? dev->ifindex : 0;
206}
207
208static void nft_meta_store_ifname(u32 *dest, const struct net_device *dev)
209{
210 strncpy((char *)dest, dev ? dev->name : "", IFNAMSIZ);
211}
212
213static bool nft_meta_store_iftype(u32 *dest, const struct net_device *dev)
214{
215 if (!dev)
216 return false;
217
218 nft_reg_store16(dest, dev->type);
219 return true;
220}
221
222static bool nft_meta_store_ifgroup(u32 *dest, const struct net_device *dev)
223{
224 if (!dev)
225 return false;
226
227 *dest = dev->group;
228 return true;
229}
230
231static bool nft_meta_get_eval_ifname(enum nft_meta_keys key, u32 *dest,
232 const struct nft_pktinfo *pkt)
233{
234 switch (key) {
235 case NFT_META_IIFNAME:
236 nft_meta_store_ifname(dest, nft_in(pkt));
237 break;
238 case NFT_META_OIFNAME:
239 nft_meta_store_ifname(dest, nft_out(pkt));
240 break;
241 case NFT_META_IIF:
242 nft_meta_store_ifindex(dest, nft_in(pkt));
243 break;
244 case NFT_META_OIF:
245 nft_meta_store_ifindex(dest, nft_out(pkt));
246 break;
247 case NFT_META_IIFTYPE:
248 if (!nft_meta_store_iftype(dest, nft_in(pkt)))
249 return false;
250 break;
251 case NFT_META_OIFTYPE:
252 if (!nft_meta_store_iftype(dest, nft_out(pkt)))
253 return false;
254 break;
255 case NFT_META_IIFGROUP:
256 if (!nft_meta_store_ifgroup(dest, nft_in(pkt)))
257 return false;
258 break;
259 case NFT_META_OIFGROUP:
260 if (!nft_meta_store_ifgroup(dest, nft_out(pkt)))
261 return false;
262 break;
263 default:
264 return false;
265 }
266
267 return true;
268}
269
270static noinline u32 nft_prandom_u32(void)
271{
272 struct rnd_state *state = this_cpu_ptr(&nft_prandom_state);
273
274 return prandom_u32_state(state);
275}
276
277#ifdef CONFIG_IP_ROUTE_CLASSID
278static noinline bool
279nft_meta_get_eval_rtclassid(const struct sk_buff *skb, u32 *dest)
280{
281 const struct dst_entry *dst = skb_dst(skb);
282
283 if (!dst)
284 return false;
285
286 *dest = dst->tclassid;
287 return true;
288}
289#endif
290
291static noinline u32 nft_meta_get_eval_sdif(const struct nft_pktinfo *pkt)
292{
293 switch (nft_pf(pkt)) {
294 case NFPROTO_IPV4:
295 return inet_sdif(pkt->skb);
296 case NFPROTO_IPV6:
297 return inet6_sdif(pkt->skb);
298 }
299
300 return 0;
301}
302
303static noinline void
304nft_meta_get_eval_sdifname(u32 *dest, const struct nft_pktinfo *pkt)
305{
306 u32 sdif = nft_meta_get_eval_sdif(pkt);
307 const struct net_device *dev;
308
309 dev = sdif ? dev_get_by_index_rcu(nft_net(pkt), sdif) : NULL;
310 nft_meta_store_ifname(dest, dev);
311}
312
313void nft_meta_get_eval(const struct nft_expr *expr,
314 struct nft_regs *regs,
315 const struct nft_pktinfo *pkt)
316{
317 const struct nft_meta *priv = nft_expr_priv(expr);
318 const struct sk_buff *skb = pkt->skb;
319 u32 *dest = ®s->data[priv->dreg];
320
321 switch (priv->key) {
322 case NFT_META_LEN:
323 *dest = skb->len;
324 break;
325 case NFT_META_PROTOCOL:
326 nft_reg_store16(dest, (__force u16)skb->protocol);
327 break;
328 case NFT_META_NFPROTO:
329 nft_reg_store8(dest, nft_pf(pkt));
330 break;
331 case NFT_META_L4PROTO:
332 if (!pkt->tprot_set)
333 goto err;
334 nft_reg_store8(dest, pkt->tprot);
335 break;
336 case NFT_META_PRIORITY:
337 *dest = skb->priority;
338 break;
339 case NFT_META_MARK:
340 *dest = skb->mark;
341 break;
342 case NFT_META_IIF:
343 case NFT_META_OIF:
344 case NFT_META_IIFNAME:
345 case NFT_META_OIFNAME:
346 case NFT_META_IIFTYPE:
347 case NFT_META_OIFTYPE:
348 case NFT_META_IIFGROUP:
349 case NFT_META_OIFGROUP:
350 if (!nft_meta_get_eval_ifname(priv->key, dest, pkt))
351 goto err;
352 break;
353 case NFT_META_SKUID:
354 case NFT_META_SKGID:
355 if (!nft_meta_get_eval_skugid(priv->key, dest, pkt))
356 goto err;
357 break;
358#ifdef CONFIG_IP_ROUTE_CLASSID
359 case NFT_META_RTCLASSID:
360 if (!nft_meta_get_eval_rtclassid(skb, dest))
361 goto err;
362 break;
363#endif
364#ifdef CONFIG_NETWORK_SECMARK
365 case NFT_META_SECMARK:
366 *dest = skb->secmark;
367 break;
368#endif
369 case NFT_META_PKTTYPE:
370 if (skb->pkt_type != PACKET_LOOPBACK) {
371 nft_reg_store8(dest, skb->pkt_type);
372 break;
373 }
374
375 if (!nft_meta_get_eval_pkttype_lo(pkt, dest))
376 goto err;
377 break;
378 case NFT_META_CPU:
379 *dest = raw_smp_processor_id();
380 break;
381#ifdef CONFIG_CGROUP_NET_CLASSID
382 case NFT_META_CGROUP:
383 if (!nft_meta_get_eval_cgroup(dest, pkt))
384 goto err;
385 break;
386#endif
387 case NFT_META_PRANDOM:
388 *dest = nft_prandom_u32();
389 break;
390#ifdef CONFIG_XFRM
391 case NFT_META_SECPATH:
392 nft_reg_store8(dest, secpath_exists(skb));
393 break;
394#endif
395 case NFT_META_IIFKIND:
396 case NFT_META_OIFKIND:
397 if (!nft_meta_get_eval_kind(priv->key, dest, pkt))
398 goto err;
399 break;
400 case NFT_META_TIME_NS:
401 case NFT_META_TIME_DAY:
402 case NFT_META_TIME_HOUR:
403 nft_meta_get_eval_time(priv->key, dest);
404 break;
405 case NFT_META_SDIF:
406 *dest = nft_meta_get_eval_sdif(pkt);
407 break;
408 case NFT_META_SDIFNAME:
409 nft_meta_get_eval_sdifname(dest, pkt);
410 break;
411 default:
412 WARN_ON(1);
413 goto err;
414 }
415 return;
416
417err:
418 regs->verdict.code = NFT_BREAK;
419}
420EXPORT_SYMBOL_GPL(nft_meta_get_eval);
421
422void nft_meta_set_eval(const struct nft_expr *expr,
423 struct nft_regs *regs,
424 const struct nft_pktinfo *pkt)
425{
426 const struct nft_meta *meta = nft_expr_priv(expr);
427 struct sk_buff *skb = pkt->skb;
428 u32 *sreg = ®s->data[meta->sreg];
429 u32 value = *sreg;
430 u8 value8;
431
432 switch (meta->key) {
433 case NFT_META_MARK:
434 skb->mark = value;
435 break;
436 case NFT_META_PRIORITY:
437 skb->priority = value;
438 break;
439 case NFT_META_PKTTYPE:
440 value8 = nft_reg_load8(sreg);
441
442 if (skb->pkt_type != value8 &&
443 skb_pkt_type_ok(value8) &&
444 skb_pkt_type_ok(skb->pkt_type))
445 skb->pkt_type = value8;
446 break;
447 case NFT_META_NFTRACE:
448 value8 = nft_reg_load8(sreg);
449
450 skb->nf_trace = !!value8;
451 break;
452#ifdef CONFIG_NETWORK_SECMARK
453 case NFT_META_SECMARK:
454 skb->secmark = value;
455 break;
456#endif
457 default:
458 WARN_ON(1);
459 }
460}
461EXPORT_SYMBOL_GPL(nft_meta_set_eval);
462
463const struct nla_policy nft_meta_policy[NFTA_META_MAX + 1] = {
464 [NFTA_META_DREG] = { .type = NLA_U32 },
465 [NFTA_META_KEY] = { .type = NLA_U32 },
466 [NFTA_META_SREG] = { .type = NLA_U32 },
467};
468EXPORT_SYMBOL_GPL(nft_meta_policy);
469
470int nft_meta_get_init(const struct nft_ctx *ctx,
471 const struct nft_expr *expr,
472 const struct nlattr * const tb[])
473{
474 struct nft_meta *priv = nft_expr_priv(expr);
475 unsigned int len;
476
477 priv->key = ntohl(nla_get_be32(tb[NFTA_META_KEY]));
478 switch (priv->key) {
479 case NFT_META_PROTOCOL:
480 case NFT_META_IIFTYPE:
481 case NFT_META_OIFTYPE:
482 len = sizeof(u16);
483 break;
484 case NFT_META_NFPROTO:
485 case NFT_META_L4PROTO:
486 case NFT_META_LEN:
487 case NFT_META_PRIORITY:
488 case NFT_META_MARK:
489 case NFT_META_IIF:
490 case NFT_META_OIF:
491 case NFT_META_SDIF:
492 case NFT_META_SKUID:
493 case NFT_META_SKGID:
494#ifdef CONFIG_IP_ROUTE_CLASSID
495 case NFT_META_RTCLASSID:
496#endif
497#ifdef CONFIG_NETWORK_SECMARK
498 case NFT_META_SECMARK:
499#endif
500 case NFT_META_PKTTYPE:
501 case NFT_META_CPU:
502 case NFT_META_IIFGROUP:
503 case NFT_META_OIFGROUP:
504#ifdef CONFIG_CGROUP_NET_CLASSID
505 case NFT_META_CGROUP:
506#endif
507 len = sizeof(u32);
508 break;
509 case NFT_META_IIFNAME:
510 case NFT_META_OIFNAME:
511 case NFT_META_IIFKIND:
512 case NFT_META_OIFKIND:
513 case NFT_META_SDIFNAME:
514 len = IFNAMSIZ;
515 break;
516 case NFT_META_PRANDOM:
517 prandom_init_once(&nft_prandom_state);
518 len = sizeof(u32);
519 break;
520#ifdef CONFIG_XFRM
521 case NFT_META_SECPATH:
522 len = sizeof(u8);
523 break;
524#endif
525 case NFT_META_TIME_NS:
526 len = sizeof(u64);
527 break;
528 case NFT_META_TIME_DAY:
529 len = sizeof(u8);
530 break;
531 case NFT_META_TIME_HOUR:
532 len = sizeof(u32);
533 break;
534 default:
535 return -EOPNOTSUPP;
536 }
537
538 return nft_parse_register_store(ctx, tb[NFTA_META_DREG], &priv->dreg,
539 NULL, NFT_DATA_VALUE, len);
540}
541EXPORT_SYMBOL_GPL(nft_meta_get_init);
542
543static int nft_meta_get_validate_sdif(const struct nft_ctx *ctx)
544{
545 unsigned int hooks;
546
547 switch (ctx->family) {
548 case NFPROTO_IPV4:
549 case NFPROTO_IPV6:
550 case NFPROTO_INET:
551 hooks = (1 << NF_INET_LOCAL_IN) |
552 (1 << NF_INET_FORWARD);
553 break;
554 default:
555 return -EOPNOTSUPP;
556 }
557
558 return nft_chain_validate_hooks(ctx->chain, hooks);
559}
560
561static int nft_meta_get_validate_xfrm(const struct nft_ctx *ctx)
562{
563#ifdef CONFIG_XFRM
564 unsigned int hooks;
565
566 switch (ctx->family) {
567 case NFPROTO_NETDEV:
568 hooks = 1 << NF_NETDEV_INGRESS;
569 break;
570 case NFPROTO_IPV4:
571 case NFPROTO_IPV6:
572 case NFPROTO_INET:
573 hooks = (1 << NF_INET_PRE_ROUTING) |
574 (1 << NF_INET_LOCAL_IN) |
575 (1 << NF_INET_FORWARD);
576 break;
577 default:
578 return -EOPNOTSUPP;
579 }
580
581 return nft_chain_validate_hooks(ctx->chain, hooks);
582#else
583 return 0;
584#endif
585}
586
587static int nft_meta_get_validate(const struct nft_ctx *ctx,
588 const struct nft_expr *expr,
589 const struct nft_data **data)
590{
591 const struct nft_meta *priv = nft_expr_priv(expr);
592
593 switch (priv->key) {
594 case NFT_META_SECPATH:
595 return nft_meta_get_validate_xfrm(ctx);
596 case NFT_META_SDIF:
597 case NFT_META_SDIFNAME:
598 return nft_meta_get_validate_sdif(ctx);
599 default:
600 break;
601 }
602
603 return 0;
604}
605
606int nft_meta_set_validate(const struct nft_ctx *ctx,
607 const struct nft_expr *expr,
608 const struct nft_data **data)
609{
610 struct nft_meta *priv = nft_expr_priv(expr);
611 unsigned int hooks;
612
613 if (priv->key != NFT_META_PKTTYPE)
614 return 0;
615
616 switch (ctx->family) {
617 case NFPROTO_BRIDGE:
618 hooks = 1 << NF_BR_PRE_ROUTING;
619 break;
620 case NFPROTO_NETDEV:
621 hooks = 1 << NF_NETDEV_INGRESS;
622 break;
623 case NFPROTO_IPV4:
624 case NFPROTO_IPV6:
625 case NFPROTO_INET:
626 hooks = 1 << NF_INET_PRE_ROUTING;
627 break;
628 default:
629 return -EOPNOTSUPP;
630 }
631
632 return nft_chain_validate_hooks(ctx->chain, hooks);
633}
634EXPORT_SYMBOL_GPL(nft_meta_set_validate);
635
636int nft_meta_set_init(const struct nft_ctx *ctx,
637 const struct nft_expr *expr,
638 const struct nlattr * const tb[])
639{
640 struct nft_meta *priv = nft_expr_priv(expr);
641 unsigned int len;
642 int err;
643
644 priv->key = ntohl(nla_get_be32(tb[NFTA_META_KEY]));
645 switch (priv->key) {
646 case NFT_META_MARK:
647 case NFT_META_PRIORITY:
648#ifdef CONFIG_NETWORK_SECMARK
649 case NFT_META_SECMARK:
650#endif
651 len = sizeof(u32);
652 break;
653 case NFT_META_NFTRACE:
654 len = sizeof(u8);
655 break;
656 case NFT_META_PKTTYPE:
657 len = sizeof(u8);
658 break;
659 default:
660 return -EOPNOTSUPP;
661 }
662
663 err = nft_parse_register_load(tb[NFTA_META_SREG], &priv->sreg, len);
664 if (err < 0)
665 return err;
666
667 if (priv->key == NFT_META_NFTRACE)
668 static_branch_inc(&nft_trace_enabled);
669
670 return 0;
671}
672EXPORT_SYMBOL_GPL(nft_meta_set_init);
673
674int nft_meta_get_dump(struct sk_buff *skb,
675 const struct nft_expr *expr)
676{
677 const struct nft_meta *priv = nft_expr_priv(expr);
678
679 if (nla_put_be32(skb, NFTA_META_KEY, htonl(priv->key)))
680 goto nla_put_failure;
681 if (nft_dump_register(skb, NFTA_META_DREG, priv->dreg))
682 goto nla_put_failure;
683 return 0;
684
685nla_put_failure:
686 return -1;
687}
688EXPORT_SYMBOL_GPL(nft_meta_get_dump);
689
690int nft_meta_set_dump(struct sk_buff *skb, const struct nft_expr *expr)
691{
692 const struct nft_meta *priv = nft_expr_priv(expr);
693
694 if (nla_put_be32(skb, NFTA_META_KEY, htonl(priv->key)))
695 goto nla_put_failure;
696 if (nft_dump_register(skb, NFTA_META_SREG, priv->sreg))
697 goto nla_put_failure;
698
699 return 0;
700
701nla_put_failure:
702 return -1;
703}
704EXPORT_SYMBOL_GPL(nft_meta_set_dump);
705
706void nft_meta_set_destroy(const struct nft_ctx *ctx,
707 const struct nft_expr *expr)
708{
709 const struct nft_meta *priv = nft_expr_priv(expr);
710
711 if (priv->key == NFT_META_NFTRACE)
712 static_branch_dec(&nft_trace_enabled);
713}
714EXPORT_SYMBOL_GPL(nft_meta_set_destroy);
715
716static int nft_meta_get_offload(struct nft_offload_ctx *ctx,
717 struct nft_flow_rule *flow,
718 const struct nft_expr *expr)
719{
720 const struct nft_meta *priv = nft_expr_priv(expr);
721 struct nft_offload_reg *reg = &ctx->regs[priv->dreg];
722
723 switch (priv->key) {
724 case NFT_META_PROTOCOL:
725 NFT_OFFLOAD_MATCH_EXACT(FLOW_DISSECTOR_KEY_BASIC, basic, n_proto,
726 sizeof(__u16), reg);
727 nft_offload_set_dependency(ctx, NFT_OFFLOAD_DEP_NETWORK);
728 break;
729 case NFT_META_L4PROTO:
730 NFT_OFFLOAD_MATCH_EXACT(FLOW_DISSECTOR_KEY_BASIC, basic, ip_proto,
731 sizeof(__u8), reg);
732 nft_offload_set_dependency(ctx, NFT_OFFLOAD_DEP_TRANSPORT);
733 break;
734 case NFT_META_IIF:
735 NFT_OFFLOAD_MATCH_EXACT(FLOW_DISSECTOR_KEY_META, meta,
736 ingress_ifindex, sizeof(__u32), reg);
737 break;
738 case NFT_META_IIFTYPE:
739 NFT_OFFLOAD_MATCH_EXACT(FLOW_DISSECTOR_KEY_META, meta,
740 ingress_iftype, sizeof(__u16), reg);
741 break;
742 default:
743 return -EOPNOTSUPP;
744 }
745
746 return 0;
747}
748
749static const struct nft_expr_ops nft_meta_get_ops = {
750 .type = &nft_meta_type,
751 .size = NFT_EXPR_SIZE(sizeof(struct nft_meta)),
752 .eval = nft_meta_get_eval,
753 .init = nft_meta_get_init,
754 .dump = nft_meta_get_dump,
755 .validate = nft_meta_get_validate,
756 .offload = nft_meta_get_offload,
757};
758
759static const struct nft_expr_ops nft_meta_set_ops = {
760 .type = &nft_meta_type,
761 .size = NFT_EXPR_SIZE(sizeof(struct nft_meta)),
762 .eval = nft_meta_set_eval,
763 .init = nft_meta_set_init,
764 .destroy = nft_meta_set_destroy,
765 .dump = nft_meta_set_dump,
766 .validate = nft_meta_set_validate,
767};
768
769static const struct nft_expr_ops *
770nft_meta_select_ops(const struct nft_ctx *ctx,
771 const struct nlattr * const tb[])
772{
773 if (tb[NFTA_META_KEY] == NULL)
774 return ERR_PTR(-EINVAL);
775
776 if (tb[NFTA_META_DREG] && tb[NFTA_META_SREG])
777 return ERR_PTR(-EINVAL);
778
779#if IS_ENABLED(CONFIG_NF_TABLES_BRIDGE) && IS_MODULE(CONFIG_NFT_BRIDGE_META)
780 if (ctx->family == NFPROTO_BRIDGE)
781 return ERR_PTR(-EAGAIN);
782#endif
783 if (tb[NFTA_META_DREG])
784 return &nft_meta_get_ops;
785
786 if (tb[NFTA_META_SREG])
787 return &nft_meta_set_ops;
788
789 return ERR_PTR(-EINVAL);
790}
791
792struct nft_expr_type nft_meta_type __read_mostly = {
793 .name = "meta",
794 .select_ops = nft_meta_select_ops,
795 .policy = nft_meta_policy,
796 .maxattr = NFTA_META_MAX,
797 .owner = THIS_MODULE,
798};
799
800#ifdef CONFIG_NETWORK_SECMARK
801struct nft_secmark {
802 u32 secid;
803 char *ctx;
804};
805
806static const struct nla_policy nft_secmark_policy[NFTA_SECMARK_MAX + 1] = {
807 [NFTA_SECMARK_CTX] = { .type = NLA_STRING, .len = NFT_SECMARK_CTX_MAXLEN },
808};
809
810static int nft_secmark_compute_secid(struct nft_secmark *priv)
811{
812 u32 tmp_secid = 0;
813 int err;
814
815 err = security_secctx_to_secid(priv->ctx, strlen(priv->ctx), &tmp_secid);
816 if (err)
817 return err;
818
819 if (!tmp_secid)
820 return -ENOENT;
821
822 err = security_secmark_relabel_packet(tmp_secid);
823 if (err)
824 return err;
825
826 priv->secid = tmp_secid;
827 return 0;
828}
829
830static void nft_secmark_obj_eval(struct nft_object *obj, struct nft_regs *regs,
831 const struct nft_pktinfo *pkt)
832{
833 const struct nft_secmark *priv = nft_obj_data(obj);
834 struct sk_buff *skb = pkt->skb;
835
836 skb->secmark = priv->secid;
837}
838
839static int nft_secmark_obj_init(const struct nft_ctx *ctx,
840 const struct nlattr * const tb[],
841 struct nft_object *obj)
842{
843 struct nft_secmark *priv = nft_obj_data(obj);
844 int err;
845
846 if (tb[NFTA_SECMARK_CTX] == NULL)
847 return -EINVAL;
848
849 priv->ctx = nla_strdup(tb[NFTA_SECMARK_CTX], GFP_KERNEL);
850 if (!priv->ctx)
851 return -ENOMEM;
852
853 err = nft_secmark_compute_secid(priv);
854 if (err) {
855 kfree(priv->ctx);
856 return err;
857 }
858
859 security_secmark_refcount_inc();
860
861 return 0;
862}
863
864static int nft_secmark_obj_dump(struct sk_buff *skb, struct nft_object *obj,
865 bool reset)
866{
867 struct nft_secmark *priv = nft_obj_data(obj);
868 int err;
869
870 if (nla_put_string(skb, NFTA_SECMARK_CTX, priv->ctx))
871 return -1;
872
873 if (reset) {
874 err = nft_secmark_compute_secid(priv);
875 if (err)
876 return err;
877 }
878
879 return 0;
880}
881
882static void nft_secmark_obj_destroy(const struct nft_ctx *ctx, struct nft_object *obj)
883{
884 struct nft_secmark *priv = nft_obj_data(obj);
885
886 security_secmark_refcount_dec();
887
888 kfree(priv->ctx);
889}
890
891static const struct nft_object_ops nft_secmark_obj_ops = {
892 .type = &nft_secmark_obj_type,
893 .size = sizeof(struct nft_secmark),
894 .init = nft_secmark_obj_init,
895 .eval = nft_secmark_obj_eval,
896 .dump = nft_secmark_obj_dump,
897 .destroy = nft_secmark_obj_destroy,
898};
899struct nft_object_type nft_secmark_obj_type __read_mostly = {
900 .type = NFT_OBJECT_SECMARK,
901 .ops = &nft_secmark_obj_ops,
902 .maxattr = NFTA_SECMARK_MAX,
903 .policy = nft_secmark_policy,
904 .owner = THIS_MODULE,
905};
906#endif /* CONFIG_NETWORK_SECMARK */
1// SPDX-License-Identifier: GPL-2.0-only
2/*
3 * Copyright (c) 2008-2009 Patrick McHardy <kaber@trash.net>
4 * Copyright (c) 2014 Intel Corporation
5 * Author: Tomasz Bursztyka <tomasz.bursztyka@linux.intel.com>
6 *
7 * Development of this code funded by Astaro AG (http://www.astaro.com/)
8 */
9
10#include <linux/kernel.h>
11#include <linux/netlink.h>
12#include <linux/netfilter.h>
13#include <linux/netfilter/nf_tables.h>
14#include <linux/in.h>
15#include <linux/ip.h>
16#include <linux/ipv6.h>
17#include <linux/random.h>
18#include <linux/smp.h>
19#include <linux/static_key.h>
20#include <net/dst.h>
21#include <net/ip.h>
22#include <net/sock.h>
23#include <net/tcp_states.h> /* for TCP_TIME_WAIT */
24#include <net/netfilter/nf_tables.h>
25#include <net/netfilter/nf_tables_core.h>
26#include <net/netfilter/nft_meta.h>
27#include <net/netfilter/nf_tables_offload.h>
28
29#include <uapi/linux/netfilter_bridge.h> /* NF_BR_PRE_ROUTING */
30
31#define NFT_META_SECS_PER_MINUTE 60
32#define NFT_META_SECS_PER_HOUR 3600
33#define NFT_META_SECS_PER_DAY 86400
34#define NFT_META_DAYS_PER_WEEK 7
35
36static u8 nft_meta_weekday(void)
37{
38 time64_t secs = ktime_get_real_seconds();
39 unsigned int dse;
40 u8 wday;
41
42 secs -= NFT_META_SECS_PER_MINUTE * sys_tz.tz_minuteswest;
43 dse = div_u64(secs, NFT_META_SECS_PER_DAY);
44 wday = (4 + dse) % NFT_META_DAYS_PER_WEEK;
45
46 return wday;
47}
48
49static u32 nft_meta_hour(time64_t secs)
50{
51 struct tm tm;
52
53 time64_to_tm(secs, 0, &tm);
54
55 return tm.tm_hour * NFT_META_SECS_PER_HOUR
56 + tm.tm_min * NFT_META_SECS_PER_MINUTE
57 + tm.tm_sec;
58}
59
60static noinline_for_stack void
61nft_meta_get_eval_time(enum nft_meta_keys key,
62 u32 *dest)
63{
64 switch (key) {
65 case NFT_META_TIME_NS:
66 nft_reg_store64((u64 *)dest, ktime_get_real_ns());
67 break;
68 case NFT_META_TIME_DAY:
69 nft_reg_store8(dest, nft_meta_weekday());
70 break;
71 case NFT_META_TIME_HOUR:
72 *dest = nft_meta_hour(ktime_get_real_seconds());
73 break;
74 default:
75 break;
76 }
77}
78
79static noinline bool
80nft_meta_get_eval_pkttype_lo(const struct nft_pktinfo *pkt,
81 u32 *dest)
82{
83 const struct sk_buff *skb = pkt->skb;
84
85 switch (nft_pf(pkt)) {
86 case NFPROTO_IPV4:
87 if (ipv4_is_multicast(ip_hdr(skb)->daddr))
88 nft_reg_store8(dest, PACKET_MULTICAST);
89 else
90 nft_reg_store8(dest, PACKET_BROADCAST);
91 break;
92 case NFPROTO_IPV6:
93 nft_reg_store8(dest, PACKET_MULTICAST);
94 break;
95 case NFPROTO_NETDEV:
96 switch (skb->protocol) {
97 case htons(ETH_P_IP): {
98 int noff = skb_network_offset(skb);
99 struct iphdr *iph, _iph;
100
101 iph = skb_header_pointer(skb, noff,
102 sizeof(_iph), &_iph);
103 if (!iph)
104 return false;
105
106 if (ipv4_is_multicast(iph->daddr))
107 nft_reg_store8(dest, PACKET_MULTICAST);
108 else
109 nft_reg_store8(dest, PACKET_BROADCAST);
110
111 break;
112 }
113 case htons(ETH_P_IPV6):
114 nft_reg_store8(dest, PACKET_MULTICAST);
115 break;
116 default:
117 WARN_ON_ONCE(1);
118 return false;
119 }
120 break;
121 default:
122 WARN_ON_ONCE(1);
123 return false;
124 }
125
126 return true;
127}
128
129static noinline bool
130nft_meta_get_eval_skugid(enum nft_meta_keys key,
131 u32 *dest,
132 const struct nft_pktinfo *pkt)
133{
134 struct sock *sk = skb_to_full_sk(pkt->skb);
135 struct socket *sock;
136
137 if (!sk || !sk_fullsock(sk) || !net_eq(nft_net(pkt), sock_net(sk)))
138 return false;
139
140 read_lock_bh(&sk->sk_callback_lock);
141 sock = sk->sk_socket;
142 if (!sock || !sock->file) {
143 read_unlock_bh(&sk->sk_callback_lock);
144 return false;
145 }
146
147 switch (key) {
148 case NFT_META_SKUID:
149 *dest = from_kuid_munged(sock_net(sk)->user_ns,
150 sock->file->f_cred->fsuid);
151 break;
152 case NFT_META_SKGID:
153 *dest = from_kgid_munged(sock_net(sk)->user_ns,
154 sock->file->f_cred->fsgid);
155 break;
156 default:
157 break;
158 }
159
160 read_unlock_bh(&sk->sk_callback_lock);
161 return true;
162}
163
164#ifdef CONFIG_CGROUP_NET_CLASSID
165static noinline bool
166nft_meta_get_eval_cgroup(u32 *dest, const struct nft_pktinfo *pkt)
167{
168 struct sock *sk = skb_to_full_sk(pkt->skb);
169
170 if (!sk || !sk_fullsock(sk) || !net_eq(nft_net(pkt), sock_net(sk)))
171 return false;
172
173 *dest = sock_cgroup_classid(&sk->sk_cgrp_data);
174 return true;
175}
176#endif
177
178static noinline bool nft_meta_get_eval_kind(enum nft_meta_keys key,
179 u32 *dest,
180 const struct nft_pktinfo *pkt)
181{
182 const struct net_device *in = nft_in(pkt), *out = nft_out(pkt);
183
184 switch (key) {
185 case NFT_META_IIFKIND:
186 if (!in || !in->rtnl_link_ops)
187 return false;
188 strscpy_pad((char *)dest, in->rtnl_link_ops->kind, IFNAMSIZ);
189 break;
190 case NFT_META_OIFKIND:
191 if (!out || !out->rtnl_link_ops)
192 return false;
193 strscpy_pad((char *)dest, out->rtnl_link_ops->kind, IFNAMSIZ);
194 break;
195 default:
196 return false;
197 }
198
199 return true;
200}
201
202static void nft_meta_store_ifindex(u32 *dest, const struct net_device *dev)
203{
204 *dest = dev ? dev->ifindex : 0;
205}
206
207static void nft_meta_store_ifname(u32 *dest, const struct net_device *dev)
208{
209 strscpy_pad((char *)dest, dev ? dev->name : "", IFNAMSIZ);
210}
211
212static bool nft_meta_store_iftype(u32 *dest, const struct net_device *dev)
213{
214 if (!dev)
215 return false;
216
217 nft_reg_store16(dest, dev->type);
218 return true;
219}
220
221static bool nft_meta_store_ifgroup(u32 *dest, const struct net_device *dev)
222{
223 if (!dev)
224 return false;
225
226 *dest = dev->group;
227 return true;
228}
229
230static bool nft_meta_get_eval_ifname(enum nft_meta_keys key, u32 *dest,
231 const struct nft_pktinfo *pkt)
232{
233 switch (key) {
234 case NFT_META_IIFNAME:
235 nft_meta_store_ifname(dest, nft_in(pkt));
236 break;
237 case NFT_META_OIFNAME:
238 nft_meta_store_ifname(dest, nft_out(pkt));
239 break;
240 case NFT_META_IIF:
241 nft_meta_store_ifindex(dest, nft_in(pkt));
242 break;
243 case NFT_META_OIF:
244 nft_meta_store_ifindex(dest, nft_out(pkt));
245 break;
246 case NFT_META_IFTYPE:
247 if (!nft_meta_store_iftype(dest, pkt->skb->dev))
248 return false;
249 break;
250 case __NFT_META_IIFTYPE:
251 if (!nft_meta_store_iftype(dest, nft_in(pkt)))
252 return false;
253 break;
254 case NFT_META_OIFTYPE:
255 if (!nft_meta_store_iftype(dest, nft_out(pkt)))
256 return false;
257 break;
258 case NFT_META_IIFGROUP:
259 if (!nft_meta_store_ifgroup(dest, nft_in(pkt)))
260 return false;
261 break;
262 case NFT_META_OIFGROUP:
263 if (!nft_meta_store_ifgroup(dest, nft_out(pkt)))
264 return false;
265 break;
266 default:
267 return false;
268 }
269
270 return true;
271}
272
273#ifdef CONFIG_IP_ROUTE_CLASSID
274static noinline bool
275nft_meta_get_eval_rtclassid(const struct sk_buff *skb, u32 *dest)
276{
277 const struct dst_entry *dst = skb_dst(skb);
278
279 if (!dst)
280 return false;
281
282 *dest = dst->tclassid;
283 return true;
284}
285#endif
286
287static noinline u32 nft_meta_get_eval_sdif(const struct nft_pktinfo *pkt)
288{
289 switch (nft_pf(pkt)) {
290 case NFPROTO_IPV4:
291 return inet_sdif(pkt->skb);
292 case NFPROTO_IPV6:
293 return inet6_sdif(pkt->skb);
294 }
295
296 return 0;
297}
298
299static noinline void
300nft_meta_get_eval_sdifname(u32 *dest, const struct nft_pktinfo *pkt)
301{
302 u32 sdif = nft_meta_get_eval_sdif(pkt);
303 const struct net_device *dev;
304
305 dev = sdif ? dev_get_by_index_rcu(nft_net(pkt), sdif) : NULL;
306 nft_meta_store_ifname(dest, dev);
307}
308
309void nft_meta_get_eval(const struct nft_expr *expr,
310 struct nft_regs *regs,
311 const struct nft_pktinfo *pkt)
312{
313 const struct nft_meta *priv = nft_expr_priv(expr);
314 const struct sk_buff *skb = pkt->skb;
315 u32 *dest = ®s->data[priv->dreg];
316
317 switch (priv->key) {
318 case NFT_META_LEN:
319 *dest = skb->len;
320 break;
321 case NFT_META_PROTOCOL:
322 nft_reg_store16(dest, (__force u16)skb->protocol);
323 break;
324 case NFT_META_NFPROTO:
325 nft_reg_store8(dest, nft_pf(pkt));
326 break;
327 case NFT_META_L4PROTO:
328 if (!(pkt->flags & NFT_PKTINFO_L4PROTO))
329 goto err;
330 nft_reg_store8(dest, pkt->tprot);
331 break;
332 case NFT_META_PRIORITY:
333 *dest = skb->priority;
334 break;
335 case NFT_META_MARK:
336 *dest = skb->mark;
337 break;
338 case NFT_META_IIF:
339 case NFT_META_OIF:
340 case NFT_META_IIFNAME:
341 case NFT_META_OIFNAME:
342 case NFT_META_IIFTYPE:
343 case NFT_META_OIFTYPE:
344 case NFT_META_IIFGROUP:
345 case NFT_META_OIFGROUP:
346 if (!nft_meta_get_eval_ifname(priv->key, dest, pkt))
347 goto err;
348 break;
349 case NFT_META_SKUID:
350 case NFT_META_SKGID:
351 if (!nft_meta_get_eval_skugid(priv->key, dest, pkt))
352 goto err;
353 break;
354#ifdef CONFIG_IP_ROUTE_CLASSID
355 case NFT_META_RTCLASSID:
356 if (!nft_meta_get_eval_rtclassid(skb, dest))
357 goto err;
358 break;
359#endif
360#ifdef CONFIG_NETWORK_SECMARK
361 case NFT_META_SECMARK:
362 *dest = skb->secmark;
363 break;
364#endif
365 case NFT_META_PKTTYPE:
366 if (skb->pkt_type != PACKET_LOOPBACK) {
367 nft_reg_store8(dest, skb->pkt_type);
368 break;
369 }
370
371 if (!nft_meta_get_eval_pkttype_lo(pkt, dest))
372 goto err;
373 break;
374 case NFT_META_CPU:
375 *dest = raw_smp_processor_id();
376 break;
377#ifdef CONFIG_CGROUP_NET_CLASSID
378 case NFT_META_CGROUP:
379 if (!nft_meta_get_eval_cgroup(dest, pkt))
380 goto err;
381 break;
382#endif
383 case NFT_META_PRANDOM:
384 *dest = get_random_u32();
385 break;
386#ifdef CONFIG_XFRM
387 case NFT_META_SECPATH:
388 nft_reg_store8(dest, secpath_exists(skb));
389 break;
390#endif
391 case NFT_META_IIFKIND:
392 case NFT_META_OIFKIND:
393 if (!nft_meta_get_eval_kind(priv->key, dest, pkt))
394 goto err;
395 break;
396 case NFT_META_TIME_NS:
397 case NFT_META_TIME_DAY:
398 case NFT_META_TIME_HOUR:
399 nft_meta_get_eval_time(priv->key, dest);
400 break;
401 case NFT_META_SDIF:
402 *dest = nft_meta_get_eval_sdif(pkt);
403 break;
404 case NFT_META_SDIFNAME:
405 nft_meta_get_eval_sdifname(dest, pkt);
406 break;
407 default:
408 WARN_ON(1);
409 goto err;
410 }
411 return;
412
413err:
414 regs->verdict.code = NFT_BREAK;
415}
416EXPORT_SYMBOL_GPL(nft_meta_get_eval);
417
418void nft_meta_set_eval(const struct nft_expr *expr,
419 struct nft_regs *regs,
420 const struct nft_pktinfo *pkt)
421{
422 const struct nft_meta *meta = nft_expr_priv(expr);
423 struct sk_buff *skb = pkt->skb;
424 u32 *sreg = ®s->data[meta->sreg];
425 u32 value = *sreg;
426 u8 value8;
427
428 switch (meta->key) {
429 case NFT_META_MARK:
430 skb->mark = value;
431 break;
432 case NFT_META_PRIORITY:
433 skb->priority = value;
434 break;
435 case NFT_META_PKTTYPE:
436 value8 = nft_reg_load8(sreg);
437
438 if (skb->pkt_type != value8 &&
439 skb_pkt_type_ok(value8) &&
440 skb_pkt_type_ok(skb->pkt_type))
441 skb->pkt_type = value8;
442 break;
443 case NFT_META_NFTRACE:
444 value8 = nft_reg_load8(sreg);
445
446 skb->nf_trace = !!value8;
447 break;
448#ifdef CONFIG_NETWORK_SECMARK
449 case NFT_META_SECMARK:
450 skb->secmark = value;
451 break;
452#endif
453 default:
454 WARN_ON(1);
455 }
456}
457EXPORT_SYMBOL_GPL(nft_meta_set_eval);
458
459const struct nla_policy nft_meta_policy[NFTA_META_MAX + 1] = {
460 [NFTA_META_DREG] = { .type = NLA_U32 },
461 [NFTA_META_KEY] = NLA_POLICY_MAX(NLA_BE32, 255),
462 [NFTA_META_SREG] = { .type = NLA_U32 },
463};
464EXPORT_SYMBOL_GPL(nft_meta_policy);
465
466int nft_meta_get_init(const struct nft_ctx *ctx,
467 const struct nft_expr *expr,
468 const struct nlattr * const tb[])
469{
470 struct nft_meta *priv = nft_expr_priv(expr);
471 unsigned int len;
472
473 priv->key = ntohl(nla_get_be32(tb[NFTA_META_KEY]));
474 switch (priv->key) {
475 case NFT_META_PROTOCOL:
476 case NFT_META_IIFTYPE:
477 case NFT_META_OIFTYPE:
478 len = sizeof(u16);
479 break;
480 case NFT_META_NFPROTO:
481 case NFT_META_L4PROTO:
482 case NFT_META_LEN:
483 case NFT_META_PRIORITY:
484 case NFT_META_MARK:
485 case NFT_META_IIF:
486 case NFT_META_OIF:
487 case NFT_META_SDIF:
488 case NFT_META_SKUID:
489 case NFT_META_SKGID:
490#ifdef CONFIG_IP_ROUTE_CLASSID
491 case NFT_META_RTCLASSID:
492#endif
493#ifdef CONFIG_NETWORK_SECMARK
494 case NFT_META_SECMARK:
495#endif
496 case NFT_META_PKTTYPE:
497 case NFT_META_CPU:
498 case NFT_META_IIFGROUP:
499 case NFT_META_OIFGROUP:
500#ifdef CONFIG_CGROUP_NET_CLASSID
501 case NFT_META_CGROUP:
502#endif
503 len = sizeof(u32);
504 break;
505 case NFT_META_IIFNAME:
506 case NFT_META_OIFNAME:
507 case NFT_META_IIFKIND:
508 case NFT_META_OIFKIND:
509 case NFT_META_SDIFNAME:
510 len = IFNAMSIZ;
511 break;
512 case NFT_META_PRANDOM:
513 len = sizeof(u32);
514 break;
515#ifdef CONFIG_XFRM
516 case NFT_META_SECPATH:
517 len = sizeof(u8);
518 break;
519#endif
520 case NFT_META_TIME_NS:
521 len = sizeof(u64);
522 break;
523 case NFT_META_TIME_DAY:
524 len = sizeof(u8);
525 break;
526 case NFT_META_TIME_HOUR:
527 len = sizeof(u32);
528 break;
529 default:
530 return -EOPNOTSUPP;
531 }
532
533 priv->len = len;
534 return nft_parse_register_store(ctx, tb[NFTA_META_DREG], &priv->dreg,
535 NULL, NFT_DATA_VALUE, len);
536}
537EXPORT_SYMBOL_GPL(nft_meta_get_init);
538
539static int nft_meta_get_validate_sdif(const struct nft_ctx *ctx)
540{
541 unsigned int hooks;
542
543 switch (ctx->family) {
544 case NFPROTO_IPV4:
545 case NFPROTO_IPV6:
546 case NFPROTO_INET:
547 hooks = (1 << NF_INET_LOCAL_IN) |
548 (1 << NF_INET_FORWARD);
549 break;
550 default:
551 return -EOPNOTSUPP;
552 }
553
554 return nft_chain_validate_hooks(ctx->chain, hooks);
555}
556
557static int nft_meta_get_validate_xfrm(const struct nft_ctx *ctx)
558{
559#ifdef CONFIG_XFRM
560 unsigned int hooks;
561
562 switch (ctx->family) {
563 case NFPROTO_NETDEV:
564 hooks = 1 << NF_NETDEV_INGRESS;
565 break;
566 case NFPROTO_IPV4:
567 case NFPROTO_IPV6:
568 case NFPROTO_INET:
569 hooks = (1 << NF_INET_PRE_ROUTING) |
570 (1 << NF_INET_LOCAL_IN) |
571 (1 << NF_INET_FORWARD);
572 break;
573 default:
574 return -EOPNOTSUPP;
575 }
576
577 return nft_chain_validate_hooks(ctx->chain, hooks);
578#else
579 return 0;
580#endif
581}
582
583static int nft_meta_get_validate(const struct nft_ctx *ctx,
584 const struct nft_expr *expr)
585{
586 const struct nft_meta *priv = nft_expr_priv(expr);
587
588 switch (priv->key) {
589 case NFT_META_SECPATH:
590 return nft_meta_get_validate_xfrm(ctx);
591 case NFT_META_SDIF:
592 case NFT_META_SDIFNAME:
593 return nft_meta_get_validate_sdif(ctx);
594 default:
595 break;
596 }
597
598 return 0;
599}
600
601int nft_meta_set_validate(const struct nft_ctx *ctx,
602 const struct nft_expr *expr)
603{
604 struct nft_meta *priv = nft_expr_priv(expr);
605 unsigned int hooks;
606
607 if (priv->key != NFT_META_PKTTYPE)
608 return 0;
609
610 switch (ctx->family) {
611 case NFPROTO_BRIDGE:
612 hooks = 1 << NF_BR_PRE_ROUTING;
613 break;
614 case NFPROTO_NETDEV:
615 hooks = 1 << NF_NETDEV_INGRESS;
616 break;
617 case NFPROTO_IPV4:
618 case NFPROTO_IPV6:
619 case NFPROTO_INET:
620 hooks = 1 << NF_INET_PRE_ROUTING;
621 break;
622 default:
623 return -EOPNOTSUPP;
624 }
625
626 return nft_chain_validate_hooks(ctx->chain, hooks);
627}
628EXPORT_SYMBOL_GPL(nft_meta_set_validate);
629
630int nft_meta_set_init(const struct nft_ctx *ctx,
631 const struct nft_expr *expr,
632 const struct nlattr * const tb[])
633{
634 struct nft_meta *priv = nft_expr_priv(expr);
635 unsigned int len;
636 int err;
637
638 priv->key = ntohl(nla_get_be32(tb[NFTA_META_KEY]));
639 switch (priv->key) {
640 case NFT_META_MARK:
641 case NFT_META_PRIORITY:
642#ifdef CONFIG_NETWORK_SECMARK
643 case NFT_META_SECMARK:
644#endif
645 len = sizeof(u32);
646 break;
647 case NFT_META_NFTRACE:
648 len = sizeof(u8);
649 break;
650 case NFT_META_PKTTYPE:
651 len = sizeof(u8);
652 break;
653 default:
654 return -EOPNOTSUPP;
655 }
656
657 priv->len = len;
658 err = nft_parse_register_load(ctx, tb[NFTA_META_SREG], &priv->sreg, len);
659 if (err < 0)
660 return err;
661
662 if (priv->key == NFT_META_NFTRACE)
663 static_branch_inc(&nft_trace_enabled);
664
665 return 0;
666}
667EXPORT_SYMBOL_GPL(nft_meta_set_init);
668
669int nft_meta_get_dump(struct sk_buff *skb,
670 const struct nft_expr *expr, bool reset)
671{
672 const struct nft_meta *priv = nft_expr_priv(expr);
673
674 if (nla_put_be32(skb, NFTA_META_KEY, htonl(priv->key)))
675 goto nla_put_failure;
676 if (nft_dump_register(skb, NFTA_META_DREG, priv->dreg))
677 goto nla_put_failure;
678 return 0;
679
680nla_put_failure:
681 return -1;
682}
683EXPORT_SYMBOL_GPL(nft_meta_get_dump);
684
685int nft_meta_set_dump(struct sk_buff *skb,
686 const struct nft_expr *expr, bool reset)
687{
688 const struct nft_meta *priv = nft_expr_priv(expr);
689
690 if (nla_put_be32(skb, NFTA_META_KEY, htonl(priv->key)))
691 goto nla_put_failure;
692 if (nft_dump_register(skb, NFTA_META_SREG, priv->sreg))
693 goto nla_put_failure;
694
695 return 0;
696
697nla_put_failure:
698 return -1;
699}
700EXPORT_SYMBOL_GPL(nft_meta_set_dump);
701
702void nft_meta_set_destroy(const struct nft_ctx *ctx,
703 const struct nft_expr *expr)
704{
705 const struct nft_meta *priv = nft_expr_priv(expr);
706
707 if (priv->key == NFT_META_NFTRACE)
708 static_branch_dec(&nft_trace_enabled);
709}
710EXPORT_SYMBOL_GPL(nft_meta_set_destroy);
711
712static int nft_meta_get_offload(struct nft_offload_ctx *ctx,
713 struct nft_flow_rule *flow,
714 const struct nft_expr *expr)
715{
716 const struct nft_meta *priv = nft_expr_priv(expr);
717 struct nft_offload_reg *reg = &ctx->regs[priv->dreg];
718
719 switch (priv->key) {
720 case NFT_META_PROTOCOL:
721 NFT_OFFLOAD_MATCH_EXACT(FLOW_DISSECTOR_KEY_BASIC, basic, n_proto,
722 sizeof(__u16), reg);
723 nft_offload_set_dependency(ctx, NFT_OFFLOAD_DEP_NETWORK);
724 break;
725 case NFT_META_L4PROTO:
726 NFT_OFFLOAD_MATCH_EXACT(FLOW_DISSECTOR_KEY_BASIC, basic, ip_proto,
727 sizeof(__u8), reg);
728 nft_offload_set_dependency(ctx, NFT_OFFLOAD_DEP_TRANSPORT);
729 break;
730 case NFT_META_IIF:
731 NFT_OFFLOAD_MATCH_EXACT(FLOW_DISSECTOR_KEY_META, meta,
732 ingress_ifindex, sizeof(__u32), reg);
733 break;
734 case NFT_META_IIFTYPE:
735 NFT_OFFLOAD_MATCH_EXACT(FLOW_DISSECTOR_KEY_META, meta,
736 ingress_iftype, sizeof(__u16), reg);
737 break;
738 default:
739 return -EOPNOTSUPP;
740 }
741
742 return 0;
743}
744
745bool nft_meta_get_reduce(struct nft_regs_track *track,
746 const struct nft_expr *expr)
747{
748 const struct nft_meta *priv = nft_expr_priv(expr);
749 const struct nft_meta *meta;
750
751 if (!nft_reg_track_cmp(track, expr, priv->dreg)) {
752 nft_reg_track_update(track, expr, priv->dreg, priv->len);
753 return false;
754 }
755
756 meta = nft_expr_priv(track->regs[priv->dreg].selector);
757 if (priv->key != meta->key ||
758 priv->dreg != meta->dreg) {
759 nft_reg_track_update(track, expr, priv->dreg, priv->len);
760 return false;
761 }
762
763 if (!track->regs[priv->dreg].bitwise)
764 return true;
765
766 return nft_expr_reduce_bitwise(track, expr);
767}
768EXPORT_SYMBOL_GPL(nft_meta_get_reduce);
769
770static const struct nft_expr_ops nft_meta_get_ops = {
771 .type = &nft_meta_type,
772 .size = NFT_EXPR_SIZE(sizeof(struct nft_meta)),
773 .eval = nft_meta_get_eval,
774 .init = nft_meta_get_init,
775 .dump = nft_meta_get_dump,
776 .reduce = nft_meta_get_reduce,
777 .validate = nft_meta_get_validate,
778 .offload = nft_meta_get_offload,
779};
780
781static bool nft_meta_set_reduce(struct nft_regs_track *track,
782 const struct nft_expr *expr)
783{
784 int i;
785
786 for (i = 0; i < NFT_REG32_NUM; i++) {
787 if (!track->regs[i].selector)
788 continue;
789
790 if (track->regs[i].selector->ops != &nft_meta_get_ops)
791 continue;
792
793 __nft_reg_track_cancel(track, i);
794 }
795
796 return false;
797}
798
799static const struct nft_expr_ops nft_meta_set_ops = {
800 .type = &nft_meta_type,
801 .size = NFT_EXPR_SIZE(sizeof(struct nft_meta)),
802 .eval = nft_meta_set_eval,
803 .init = nft_meta_set_init,
804 .destroy = nft_meta_set_destroy,
805 .dump = nft_meta_set_dump,
806 .reduce = nft_meta_set_reduce,
807 .validate = nft_meta_set_validate,
808};
809
810static const struct nft_expr_ops *
811nft_meta_select_ops(const struct nft_ctx *ctx,
812 const struct nlattr * const tb[])
813{
814 if (tb[NFTA_META_KEY] == NULL)
815 return ERR_PTR(-EINVAL);
816
817 if (tb[NFTA_META_DREG] && tb[NFTA_META_SREG])
818 return ERR_PTR(-EINVAL);
819
820#if IS_ENABLED(CONFIG_NF_TABLES_BRIDGE) && IS_MODULE(CONFIG_NFT_BRIDGE_META)
821 if (ctx->family == NFPROTO_BRIDGE)
822 return ERR_PTR(-EAGAIN);
823#endif
824 if (tb[NFTA_META_DREG])
825 return &nft_meta_get_ops;
826
827 if (tb[NFTA_META_SREG])
828 return &nft_meta_set_ops;
829
830 return ERR_PTR(-EINVAL);
831}
832
833static int nft_meta_inner_init(const struct nft_ctx *ctx,
834 const struct nft_expr *expr,
835 const struct nlattr * const tb[])
836{
837 struct nft_meta *priv = nft_expr_priv(expr);
838 unsigned int len;
839
840 if (!tb[NFTA_META_KEY] || !tb[NFTA_META_DREG])
841 return -EINVAL;
842
843 priv->key = ntohl(nla_get_be32(tb[NFTA_META_KEY]));
844 switch (priv->key) {
845 case NFT_META_PROTOCOL:
846 len = sizeof(u16);
847 break;
848 case NFT_META_L4PROTO:
849 len = sizeof(u32);
850 break;
851 default:
852 return -EOPNOTSUPP;
853 }
854 priv->len = len;
855
856 return nft_parse_register_store(ctx, tb[NFTA_META_DREG], &priv->dreg,
857 NULL, NFT_DATA_VALUE, len);
858}
859
860void nft_meta_inner_eval(const struct nft_expr *expr,
861 struct nft_regs *regs,
862 const struct nft_pktinfo *pkt,
863 struct nft_inner_tun_ctx *tun_ctx)
864{
865 const struct nft_meta *priv = nft_expr_priv(expr);
866 u32 *dest = ®s->data[priv->dreg];
867
868 switch (priv->key) {
869 case NFT_META_PROTOCOL:
870 nft_reg_store16(dest, (__force u16)tun_ctx->llproto);
871 break;
872 case NFT_META_L4PROTO:
873 if (!(tun_ctx->flags & NFT_PAYLOAD_CTX_INNER_TH))
874 goto err;
875
876 nft_reg_store8(dest, tun_ctx->l4proto);
877 break;
878 default:
879 WARN_ON_ONCE(1);
880 goto err;
881 }
882 return;
883
884err:
885 regs->verdict.code = NFT_BREAK;
886}
887EXPORT_SYMBOL_GPL(nft_meta_inner_eval);
888
889static const struct nft_expr_ops nft_meta_inner_ops = {
890 .type = &nft_meta_type,
891 .size = NFT_EXPR_SIZE(sizeof(struct nft_meta)),
892 .init = nft_meta_inner_init,
893 .dump = nft_meta_get_dump,
894 /* direct call to nft_meta_inner_eval(). */
895};
896
897struct nft_expr_type nft_meta_type __read_mostly = {
898 .name = "meta",
899 .select_ops = nft_meta_select_ops,
900 .inner_ops = &nft_meta_inner_ops,
901 .policy = nft_meta_policy,
902 .maxattr = NFTA_META_MAX,
903 .owner = THIS_MODULE,
904};
905
906#ifdef CONFIG_NETWORK_SECMARK
907struct nft_secmark {
908 u32 secid;
909 char *ctx;
910};
911
912static const struct nla_policy nft_secmark_policy[NFTA_SECMARK_MAX + 1] = {
913 [NFTA_SECMARK_CTX] = { .type = NLA_STRING, .len = NFT_SECMARK_CTX_MAXLEN },
914};
915
916static int nft_secmark_compute_secid(struct nft_secmark *priv)
917{
918 u32 tmp_secid = 0;
919 int err;
920
921 err = security_secctx_to_secid(priv->ctx, strlen(priv->ctx), &tmp_secid);
922 if (err)
923 return err;
924
925 if (!tmp_secid)
926 return -ENOENT;
927
928 err = security_secmark_relabel_packet(tmp_secid);
929 if (err)
930 return err;
931
932 priv->secid = tmp_secid;
933 return 0;
934}
935
936static void nft_secmark_obj_eval(struct nft_object *obj, struct nft_regs *regs,
937 const struct nft_pktinfo *pkt)
938{
939 const struct nft_secmark *priv = nft_obj_data(obj);
940 struct sk_buff *skb = pkt->skb;
941
942 skb->secmark = priv->secid;
943}
944
945static int nft_secmark_obj_init(const struct nft_ctx *ctx,
946 const struct nlattr * const tb[],
947 struct nft_object *obj)
948{
949 struct nft_secmark *priv = nft_obj_data(obj);
950 int err;
951
952 if (tb[NFTA_SECMARK_CTX] == NULL)
953 return -EINVAL;
954
955 priv->ctx = nla_strdup(tb[NFTA_SECMARK_CTX], GFP_KERNEL_ACCOUNT);
956 if (!priv->ctx)
957 return -ENOMEM;
958
959 err = nft_secmark_compute_secid(priv);
960 if (err) {
961 kfree(priv->ctx);
962 return err;
963 }
964
965 security_secmark_refcount_inc();
966
967 return 0;
968}
969
970static int nft_secmark_obj_dump(struct sk_buff *skb, struct nft_object *obj,
971 bool reset)
972{
973 struct nft_secmark *priv = nft_obj_data(obj);
974 int err;
975
976 if (nla_put_string(skb, NFTA_SECMARK_CTX, priv->ctx))
977 return -1;
978
979 if (reset) {
980 err = nft_secmark_compute_secid(priv);
981 if (err)
982 return err;
983 }
984
985 return 0;
986}
987
988static void nft_secmark_obj_destroy(const struct nft_ctx *ctx, struct nft_object *obj)
989{
990 struct nft_secmark *priv = nft_obj_data(obj);
991
992 security_secmark_refcount_dec();
993
994 kfree(priv->ctx);
995}
996
997static const struct nft_object_ops nft_secmark_obj_ops = {
998 .type = &nft_secmark_obj_type,
999 .size = sizeof(struct nft_secmark),
1000 .init = nft_secmark_obj_init,
1001 .eval = nft_secmark_obj_eval,
1002 .dump = nft_secmark_obj_dump,
1003 .destroy = nft_secmark_obj_destroy,
1004};
1005struct nft_object_type nft_secmark_obj_type __read_mostly = {
1006 .type = NFT_OBJECT_SECMARK,
1007 .ops = &nft_secmark_obj_ops,
1008 .maxattr = NFTA_SECMARK_MAX,
1009 .policy = nft_secmark_policy,
1010 .owner = THIS_MODULE,
1011};
1012#endif /* CONFIG_NETWORK_SECMARK */