[deliverable/linux.git] / net / netfilter / nft_meta.c

/*
 * Copyright (c) 2008-2009 Patrick McHardy <kaber@trash.net>
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 *
 * Development of this code funded by Astaro AG (http://www.astaro.com/)
 */

#include <linux/kernel.h>
#include <linux/init.h>
#include <linux/module.h>
#include <linux/netlink.h>
#include <linux/netfilter.h>
#include <linux/netfilter/nf_tables.h>
#include <linux/in.h>
#include <linux/ip.h>
#include <linux/ipv6.h>
#include <linux/smp.h>
#include <linux/static_key.h>
#include <net/dst.h>
#include <net/sock.h>
#include <net/tcp_states.h> /* for TCP_TIME_WAIT */
#include <net/netfilter/nf_tables.h>
#include <net/netfilter/nf_tables_core.h>
#include <net/netfilter/nft_meta.h>

#include <uapi/linux/netfilter_bridge.h> /* NF_BR_PRE_ROUTING */

void nft_meta_get_eval(const struct nft_expr *expr,
		       struct nft_regs *regs,
		       const struct nft_pktinfo *pkt)
{
	const struct nft_meta *priv = nft_expr_priv(expr);
	const struct sk_buff *skb = pkt->skb;
	const struct net_device *in = pkt->in, *out = pkt->out;
	struct sock *sk;
	u32 *dest = &regs->data[priv->dreg];

	switch (priv->key) {
	case NFT_META_LEN:
		*dest = skb->len;
		break;
	case NFT_META_PROTOCOL:
		*dest = 0;
		*(__be16 *)dest = skb->protocol;
		break;
	case NFT_META_NFPROTO:
		*dest = pkt->pf;
		break;
	case NFT_META_L4PROTO:
		*dest = pkt->tprot;
		break;
	case NFT_META_PRIORITY:
		*dest = skb->priority;
		break;
	case NFT_META_MARK:
		*dest = skb->mark;
		break;
	case NFT_META_IIF:
		if (in == NULL)
			goto err;
		*dest = in->ifindex;
		break;
	case NFT_META_OIF:
		if (out == NULL)
			goto err;
		*dest = out->ifindex;
		break;
	case NFT_META_IIFNAME:
		if (in == NULL)
			goto err;
		strncpy((char *)dest, in->name, IFNAMSIZ);
		break;
	case NFT_META_OIFNAME:
		if (out == NULL)
			goto err;
		strncpy((char *)dest, out->name, IFNAMSIZ);
		break;
	case NFT_META_IIFTYPE:
		if (in == NULL)
			goto err;
		*dest = 0;
		*(u16 *)dest = in->type;
		break;
	case NFT_META_OIFTYPE:
		if (out == NULL)
			goto err;
		*dest = 0;
		*(u16 *)dest = out->type;
		break;
	case NFT_META_SKUID:
		sk = skb_to_full_sk(skb);
		if (!sk || !sk_fullsock(sk))
			goto err;

		read_lock_bh(&sk->sk_callback_lock);
		if (sk->sk_socket == NULL ||
		    sk->sk_socket->file == NULL) {
			read_unlock_bh(&sk->sk_callback_lock);
			goto err;
		}

		*dest =	from_kuid_munged(&init_user_ns,
				sk->sk_socket->file->f_cred->fsuid);
		read_unlock_bh(&sk->sk_callback_lock);
		break;
	case NFT_META_SKGID:
		sk = skb_to_full_sk(skb);
		if (!sk || !sk_fullsock(sk))
			goto err;

		read_lock_bh(&sk->sk_callback_lock);
		if (sk->sk_socket == NULL ||
		    sk->sk_socket->file == NULL) {
			read_unlock_bh(&sk->sk_callback_lock);
			goto err;
		}
		*dest =	from_kgid_munged(&init_user_ns,
				 sk->sk_socket->file->f_cred->fsgid);
		read_unlock_bh(&sk->sk_callback_lock);
		break;
#ifdef CONFIG_IP_ROUTE_CLASSID
	case NFT_META_RTCLASSID: {
		const struct dst_entry *dst = skb_dst(skb);

		if (dst == NULL)
			goto err;
		*dest = dst->tclassid;
		break;
	}
#endif
#ifdef CONFIG_NETWORK_SECMARK
	case NFT_META_SECMARK:
		*dest = skb->secmark;
		break;
#endif
	case NFT_META_PKTTYPE:
		if (skb->pkt_type != PACKET_LOOPBACK) {
			*dest = skb->pkt_type;
			break;
		}

		switch (pkt->pf) {
		case NFPROTO_IPV4:
			if (ipv4_is_multicast(ip_hdr(skb)->daddr))
				*dest = PACKET_MULTICAST;
			else
				*dest = PACKET_BROADCAST;
			break;
		case NFPROTO_IPV6:
			if (ipv6_hdr(skb)->daddr.s6_addr[0] == 0xFF)
				*dest = PACKET_MULTICAST;
			else
				*dest = PACKET_BROADCAST;
			break;
		default:
			WARN_ON(1);
			goto err;
		}
		break;
	case NFT_META_CPU:
		*dest = raw_smp_processor_id();
		break;
	case NFT_META_IIFGROUP:
		if (in == NULL)
			goto err;
		*dest = in->group;
		break;
	case NFT_META_OIFGROUP:
		if (out == NULL)
			goto err;
		*dest = out->group;
		break;
#ifdef CONFIG_CGROUP_NET_CLASSID
	case NFT_META_CGROUP:
		sk = skb_to_full_sk(skb);
		if (!sk || !sk_fullsock(sk))
			goto err;
		*dest = sock_cgroup_classid(&sk->sk_cgrp_data);
		break;
#endif
	default:
		WARN_ON(1);
		goto err;
	}
	return;

err:
	regs->verdict.code = NFT_BREAK;
}
EXPORT_SYMBOL_GPL(nft_meta_get_eval);

/* don't change or set _LOOPBACK, _USER, etc. */
static bool pkt_type_ok(u32 p)
{
	return p == PACKET_HOST || p == PACKET_BROADCAST ||
	       p == PACKET_MULTICAST || p == PACKET_OTHERHOST;
}

void nft_meta_set_eval(const struct nft_expr *expr,
		       struct nft_regs *regs,
		       const struct nft_pktinfo *pkt)
{
	const struct nft_meta *meta = nft_expr_priv(expr);
	struct sk_buff *skb = pkt->skb;
	u32 value = regs->data[meta->sreg];

	switch (meta->key) {
	case NFT_META_MARK:
		skb->mark = value;
		break;
	case NFT_META_PRIORITY:
		skb->priority = value;
		break;
	case NFT_META_PKTTYPE:
		if (skb->pkt_type != value &&
		    pkt_type_ok(value) && pkt_type_ok(skb->pkt_type))
			skb->pkt_type = value;
		break;
	case NFT_META_NFTRACE:
		skb->nf_trace = 1;
		break;
	default:
		WARN_ON(1);
	}
}
EXPORT_SYMBOL_GPL(nft_meta_set_eval);

const struct nla_policy nft_meta_policy[NFTA_META_MAX + 1] = {
	[NFTA_META_DREG]	= { .type = NLA_U32 },
	[NFTA_META_KEY]		= { .type = NLA_U32 },
	[NFTA_META_SREG]	= { .type = NLA_U32 },
};
EXPORT_SYMBOL_GPL(nft_meta_policy);

int nft_meta_get_init(const struct nft_ctx *ctx,
		      const struct nft_expr *expr,
		      const struct nlattr * const tb[])
{
	struct nft_meta *priv = nft_expr_priv(expr);
	unsigned int len;

	priv->key = ntohl(nla_get_be32(tb[NFTA_META_KEY]));
	switch (priv->key) {
	case NFT_META_PROTOCOL:
	case NFT_META_IIFTYPE:
	case NFT_META_OIFTYPE:
		len = sizeof(u16);
		break;
	case NFT_META_NFPROTO:
	case NFT_META_L4PROTO:
	case NFT_META_LEN:
	case NFT_META_PRIORITY:
	case NFT_META_MARK:
	case NFT_META_IIF:
	case NFT_META_OIF:
	case NFT_META_SKUID:
	case NFT_META_SKGID:
#ifdef CONFIG_IP_ROUTE_CLASSID
	case NFT_META_RTCLASSID:
#endif
#ifdef CONFIG_NETWORK_SECMARK
	case NFT_META_SECMARK:
#endif
	case NFT_META_PKTTYPE:
	case NFT_META_CPU:
	case NFT_META_IIFGROUP:
	case NFT_META_OIFGROUP:
#ifdef CONFIG_CGROUP_NET_CLASSID
	case NFT_META_CGROUP:
#endif
		len = sizeof(u32);
		break;
	case NFT_META_IIFNAME:
	case NFT_META_OIFNAME:
		len = IFNAMSIZ;
		break;
	default:
		return -EOPNOTSUPP;
	}

	priv->dreg = nft_parse_register(tb[NFTA_META_DREG]);
	return nft_validate_register_store(ctx, priv->dreg, NULL,
					   NFT_DATA_VALUE, len);
}
EXPORT_SYMBOL_GPL(nft_meta_get_init);

static int nft_meta_set_init_pkttype(const struct nft_ctx *ctx)
{
	unsigned int hooks;

	switch (ctx->afi->family) {
	case NFPROTO_BRIDGE:
		hooks = 1 << NF_BR_PRE_ROUTING;
		break;
	case NFPROTO_NETDEV:
		hooks = 1 << NF_NETDEV_INGRESS;
		break;
	default:
		return -EOPNOTSUPP;
	}

	return nft_chain_validate_hooks(ctx->chain, hooks);
}

int nft_meta_set_init(const struct nft_ctx *ctx,
		      const struct nft_expr *expr,
		      const struct nlattr * const tb[])
{
	struct nft_meta *priv = nft_expr_priv(expr);
	unsigned int len;
	int err;

	priv->key = ntohl(nla_get_be32(tb[NFTA_META_KEY]));
	switch (priv->key) {
	case NFT_META_MARK:
	case NFT_META_PRIORITY:
		len = sizeof(u32);
		break;
	case NFT_META_NFTRACE:
		len = sizeof(u8);
		break;
	case NFT_META_PKTTYPE:
		err = nft_meta_set_init_pkttype(ctx);
		if (err)
			return err;
		len = sizeof(u8);
		break;
	default:
		return -EOPNOTSUPP;
	}

	priv->sreg = nft_parse_register(tb[NFTA_META_SREG]);
	err = nft_validate_register_load(priv->sreg, len);
	if (err < 0)
		return err;

	if (priv->key == NFT_META_NFTRACE)
		static_branch_inc(&nft_trace_enabled);

	return 0;
}
EXPORT_SYMBOL_GPL(nft_meta_set_init);

int nft_meta_get_dump(struct sk_buff *skb,
		      const struct nft_expr *expr)
{
	const struct nft_meta *priv = nft_expr_priv(expr);

	if (nla_put_be32(skb, NFTA_META_KEY, htonl(priv->key)))
		goto nla_put_failure;
	if (nft_dump_register(skb, NFTA_META_DREG, priv->dreg))
		goto nla_put_failure;
	return 0;

nla_put_failure:
	return -1;
}
EXPORT_SYMBOL_GPL(nft_meta_get_dump);

int nft_meta_set_dump(struct sk_buff *skb,
		      const struct nft_expr *expr)
{
	const struct nft_meta *priv = nft_expr_priv(expr);

	if (nla_put_be32(skb, NFTA_META_KEY, htonl(priv->key)))
		goto nla_put_failure;
	if (nft_dump_register(skb, NFTA_META_SREG, priv->sreg))
		goto nla_put_failure;

	return 0;

nla_put_failure:
	return -1;
}
EXPORT_SYMBOL_GPL(nft_meta_set_dump);

void nft_meta_set_destroy(const struct nft_ctx *ctx,
			  const struct nft_expr *expr)
{
	const struct nft_meta *priv = nft_expr_priv(expr);

	if (priv->key == NFT_META_NFTRACE)
		static_branch_dec(&nft_trace_enabled);
}
EXPORT_SYMBOL_GPL(nft_meta_set_destroy);

static struct nft_expr_type nft_meta_type;
static const struct nft_expr_ops nft_meta_get_ops = {
	.type		= &nft_meta_type,
	.size		= NFT_EXPR_SIZE(sizeof(struct nft_meta)),
	.eval		= nft_meta_get_eval,
	.init		= nft_meta_get_init,
	.dump		= nft_meta_get_dump,
};

static const struct nft_expr_ops nft_meta_set_ops = {
	.type		= &nft_meta_type,
	.size		= NFT_EXPR_SIZE(sizeof(struct nft_meta)),
	.eval		= nft_meta_set_eval,
	.init		= nft_meta_set_init,
	.destroy	= nft_meta_set_destroy,
	.dump		= nft_meta_set_dump,
};

static const struct nft_expr_ops *
nft_meta_select_ops(const struct nft_ctx *ctx,
		    const struct nlattr * const tb[])
{
	if (tb[NFTA_META_KEY] == NULL)
		return ERR_PTR(-EINVAL);

	if (tb[NFTA_META_DREG] && tb[NFTA_META_SREG])
		return ERR_PTR(-EINVAL);

	if (tb[NFTA_META_DREG])
		return &nft_meta_get_ops;

	if (tb[NFTA_META_SREG])
		return &nft_meta_set_ops;

	return ERR_PTR(-EINVAL);
}

static struct nft_expr_type nft_meta_type __read_mostly = {
	.name		= "meta",
	.select_ops	= &nft_meta_select_ops,
	.policy		= nft_meta_policy,
	.maxattr	= NFTA_META_MAX,
	.owner		= THIS_MODULE,
};

static int __init nft_meta_module_init(void)
{
	return nft_register_expr(&nft_meta_type);
}

static void __exit nft_meta_module_exit(void)
{
	nft_unregister_expr(&nft_meta_type);
}

module_init(nft_meta_module_init);
module_exit(nft_meta_module_exit);

MODULE_LICENSE("GPL");
MODULE_AUTHOR("Patrick McHardy <kaber@trash.net>");
MODULE_ALIAS_NFT_EXPR("meta");
Commit	Line	Data
96518518	1	/*
ef1f7df9	2	* Copyright (c) 2008-2009 Patrick McHardy <kaber@trash.net>
96518518 PM	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>
e2a093ff AR	17	#include <linux/in.h>
	18	#include <linux/ip.h>
	19	#include <linux/ipv6.h>
afc5be30	20	#include <linux/smp.h>
e639f7ab	21	#include <linux/static_key.h>
96518518 PM	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>
e639f7ab	26	#include <net/netfilter/nf_tables_core.h>
aa45660c	27	#include <net/netfilter/nft_meta.h>
96518518	28
b4aae759 FW	29	#include <uapi/linux/netfilter_bridge.h> /* NF_BR_PRE_ROUTING */
b4aae759 FW	30
aa45660c	31	void nft_meta_get_eval(const struct nft_expr *expr,
a55e22e9	32	struct nft_regs *regs,
aa45660c	33	const struct nft_pktinfo *pkt)
96518518 PM	34	{
	35	const struct nft_meta *priv = nft_expr_priv(expr);
	36	const struct sk_buff *skb = pkt->skb;
	37	const struct net_device in = pkt->in, out = pkt->out;
3aed8225	38	struct sock *sk;
49499c3e	39	u32 *dest = &regs->data[priv->dreg];
96518518 PM	40
	41	switch (priv->key) {
	42	case NFT_META_LEN:
fad136ea	43	*dest = skb->len;
96518518 PM	44	break;
96518518 PM	45	case NFT_META_PROTOCOL:
49499c3e	46	*dest = 0;
fad136ea	47	(__be16 )dest = skb->protocol;
96518518	48	break;
124edfa9	49	case NFT_META_NFPROTO:
6aa187f2	50	*dest = pkt->pf;
124edfa9	51	break;
4566bf27	52	case NFT_META_L4PROTO:
fad136ea	53	*dest = pkt->tprot;
4566bf27	54	break;
96518518	55	case NFT_META_PRIORITY:
fad136ea	56	*dest = skb->priority;
96518518 PM	57	break;
96518518 PM	58	case NFT_META_MARK:
fad136ea	59	*dest = skb->mark;
96518518 PM	60	break;
	61	case NFT_META_IIF:
	62	if (in == NULL)
	63	goto err;
fad136ea	64	*dest = in->ifindex;
96518518 PM	65	break;
	66	case NFT_META_OIF:
	67	if (out == NULL)
	68	goto err;
fad136ea	69	*dest = out->ifindex;
96518518 PM	70	break;
	71	case NFT_META_IIFNAME:
	72	if (in == NULL)
	73	goto err;
fad136ea	74	strncpy((char *)dest, in->name, IFNAMSIZ);
96518518 PM	75	break;
	76	case NFT_META_OIFNAME:
	77	if (out == NULL)
	78	goto err;
fad136ea	79	strncpy((char *)dest, out->name, IFNAMSIZ);
96518518 PM	80	break;
	81	case NFT_META_IIFTYPE:
	82	if (in == NULL)
	83	goto err;
49499c3e	84	*dest = 0;
fad136ea	85	(u16 )dest = in->type;
96518518 PM	86	break;
	87	case NFT_META_OIFTYPE:
	88	if (out == NULL)
	89	goto err;
49499c3e	90	*dest = 0;
fad136ea	91	(u16 )dest = out->type;
96518518 PM	92	break;
96518518 PM	93	case NFT_META_SKUID:
3aed8225 ED	94	sk = skb_to_full_sk(skb);
3aed8225 ED	95	if (!sk \|\| !sk_fullsock(sk))
96518518 PM	96	goto err;
96518518 PM	97
3aed8225 ED	98	read_lock_bh(&sk->sk_callback_lock);
	99	if (sk->sk_socket == NULL \|\|
	100	sk->sk_socket->file == NULL) {
	101	read_unlock_bh(&sk->sk_callback_lock);
96518518 PM	102	goto err;
	103	}
	104
fad136ea	105	*dest = from_kuid_munged(&init_user_ns,
3aed8225 ED	106	sk->sk_socket->file->f_cred->fsuid);
3aed8225 ED	107	read_unlock_bh(&sk->sk_callback_lock);
96518518 PM	108	break;
96518518 PM	109	case NFT_META_SKGID:
3aed8225 ED	110	sk = skb_to_full_sk(skb);
3aed8225 ED	111	if (!sk \|\| !sk_fullsock(sk))
96518518 PM	112	goto err;
96518518 PM	113
3aed8225 ED	114	read_lock_bh(&sk->sk_callback_lock);
	115	if (sk->sk_socket == NULL \|\|
	116	sk->sk_socket->file == NULL) {
	117	read_unlock_bh(&sk->sk_callback_lock);
96518518 PM	118	goto err;
96518518 PM	119	}
fad136ea	120	*dest = from_kgid_munged(&init_user_ns,
3aed8225 ED	121	sk->sk_socket->file->f_cred->fsgid);
3aed8225 ED	122	read_unlock_bh(&sk->sk_callback_lock);
96518518	123	break;
06efbd6d	124	#ifdef CONFIG_IP_ROUTE_CLASSID
96518518 PM	125	case NFT_META_RTCLASSID: {
	126	const struct dst_entry *dst = skb_dst(skb);
	127
	128	if (dst == NULL)
	129	goto err;
fad136ea	130	*dest = dst->tclassid;
96518518 PM	131	break;
	132	}
	133	#endif
	134	#ifdef CONFIG_NETWORK_SECMARK
	135	case NFT_META_SECMARK:
fad136ea	136	*dest = skb->secmark;
96518518 PM	137	break;
96518518 PM	138	#endif
e2a093ff AR	139	case NFT_META_PKTTYPE:
e2a093ff AR	140	if (skb->pkt_type != PACKET_LOOPBACK) {
fad136ea	141	*dest = skb->pkt_type;
e2a093ff AR	142	break;
	143	}
	144
6aa187f2	145	switch (pkt->pf) {
e2a093ff AR	146	case NFPROTO_IPV4:
e2a093ff AR	147	if (ipv4_is_multicast(ip_hdr(skb)->daddr))
fad136ea	148	*dest = PACKET_MULTICAST;
e2a093ff	149	else
fad136ea	150	*dest = PACKET_BROADCAST;
e2a093ff AR	151	break;
	152	case NFPROTO_IPV6:
	153	if (ipv6_hdr(skb)->daddr.s6_addr[0] == 0xFF)
fad136ea	154	*dest = PACKET_MULTICAST;
e2a093ff	155	else
fad136ea	156	*dest = PACKET_BROADCAST;
e2a093ff AR	157	break;
	158	default:
	159	WARN_ON(1);
	160	goto err;
	161	}
	162	break;
afc5be30	163	case NFT_META_CPU:
fad136ea	164	*dest = raw_smp_processor_id();
afc5be30	165	break;
3045d760 AR	166	case NFT_META_IIFGROUP:
	167	if (in == NULL)
	168	goto err;
fad136ea	169	*dest = in->group;
3045d760 AR	170	break;
	171	case NFT_META_OIFGROUP:
	172	if (out == NULL)
	173	goto err;
fad136ea	174	*dest = out->group;
3045d760	175	break;
e181a543	176	#ifdef CONFIG_CGROUP_NET_CLASSID
ce674173	177	case NFT_META_CGROUP:
3aed8225 ED	178	sk = skb_to_full_sk(skb);
3aed8225 ED	179	if (!sk \|\| !sk_fullsock(sk))
c5035c77	180	goto err;
2a56a1fe	181	*dest = sock_cgroup_classid(&sk->sk_cgrp_data);
ce674173	182	break;
e181a543	183	#endif
96518518 PM	184	default:
	185	WARN_ON(1);
	186	goto err;
	187	}
	188	return;
	189
	190	err:
a55e22e9	191	regs->verdict.code = NFT_BREAK;
96518518	192	}
aa45660c	193	EXPORT_SYMBOL_GPL(nft_meta_get_eval);
96518518	194
b4aae759 FW	195	/* don't change or set _LOOPBACK, _USER, etc. */
	196	static bool pkt_type_ok(u32 p)
	197	{
	198	return p == PACKET_HOST \|\| p == PACKET_BROADCAST \|\|
	199	p == PACKET_MULTICAST \|\| p == PACKET_OTHERHOST;
	200	}
	201
aa45660c	202	void nft_meta_set_eval(const struct nft_expr *expr,
a55e22e9	203	struct nft_regs *regs,
aa45660c	204	const struct nft_pktinfo *pkt)
e035b77a ABG	205	{
	206	const struct nft_meta *meta = nft_expr_priv(expr);
	207	struct sk_buff *skb = pkt->skb;
49499c3e	208	u32 value = regs->data[meta->sreg];
e035b77a ABG	209
	210	switch (meta->key) {
	211	case NFT_META_MARK:
	212	skb->mark = value;
	213	break;
	214	case NFT_META_PRIORITY:
	215	skb->priority = value;
	216	break;
b4aae759 FW	217	case NFT_META_PKTTYPE:
	218	if (skb->pkt_type != value &&
	219	pkt_type_ok(value) && pkt_type_ok(skb->pkt_type))
	220	skb->pkt_type = value;
	221	break;
e035b77a ABG	222	case NFT_META_NFTRACE:
	223	skb->nf_trace = 1;
	224	break;
	225	default:
	226	WARN_ON(1);
	227	}
	228	}
aa45660c	229	EXPORT_SYMBOL_GPL(nft_meta_set_eval);
e035b77a	230
aa45660c	231	const struct nla_policy nft_meta_policy[NFTA_META_MAX + 1] = {
96518518 PM	232	[NFTA_META_DREG] = { .type = NLA_U32 },
96518518 PM	233	[NFTA_META_KEY] = { .type = NLA_U32 },
e035b77a	234	[NFTA_META_SREG] = { .type = NLA_U32 },
96518518	235	};
aa45660c	236	EXPORT_SYMBOL_GPL(nft_meta_policy);
96518518	237
aa45660c TB	238	int nft_meta_get_init(const struct nft_ctx *ctx,
	239	const struct nft_expr *expr,
	240	const struct nlattr * const tb[])
96518518	241	{
d2caa696	242	struct nft_meta *priv = nft_expr_priv(expr);
45d9bcda	243	unsigned int len;
96518518	244
d2caa696 PM	245	priv->key = ntohl(nla_get_be32(tb[NFTA_META_KEY]));
d2caa696 PM	246	switch (priv->key) {
96518518	247	case NFT_META_PROTOCOL:
45d9bcda PM	248	case NFT_META_IIFTYPE:
	249	case NFT_META_OIFTYPE:
	250	len = sizeof(u16);
	251	break;
124edfa9	252	case NFT_META_NFPROTO:
4566bf27	253	case NFT_META_L4PROTO:
45d9bcda	254	case NFT_META_LEN:
96518518 PM	255	case NFT_META_PRIORITY:
	256	case NFT_META_MARK:
	257	case NFT_META_IIF:
	258	case NFT_META_OIF:
96518518 PM	259	case NFT_META_SKUID:
96518518 PM	260	case NFT_META_SKGID:
06efbd6d	261	#ifdef CONFIG_IP_ROUTE_CLASSID
96518518 PM	262	case NFT_META_RTCLASSID:
	263	#endif
	264	#ifdef CONFIG_NETWORK_SECMARK
	265	case NFT_META_SECMARK:
	266	#endif
e2a093ff	267	case NFT_META_PKTTYPE:
afc5be30	268	case NFT_META_CPU:
3045d760 AR	269	case NFT_META_IIFGROUP:
3045d760 AR	270	case NFT_META_OIFGROUP:
e181a543	271	#ifdef CONFIG_CGROUP_NET_CLASSID
ce674173	272	case NFT_META_CGROUP:
e181a543	273	#endif
45d9bcda PM	274	len = sizeof(u32);
	275	break;
	276	case NFT_META_IIFNAME:
	277	case NFT_META_OIFNAME:
	278	len = IFNAMSIZ;
d2caa696	279	break;
96518518 PM	280	default:
	281	return -EOPNOTSUPP;
	282	}
	283
b1c96ed3	284	priv->dreg = nft_parse_register(tb[NFTA_META_DREG]);
27e6d201 PM	285	return nft_validate_register_store(ctx, priv->dreg, NULL,
27e6d201 PM	286	NFT_DATA_VALUE, len);
e035b77a	287	}
aa45660c	288	EXPORT_SYMBOL_GPL(nft_meta_get_init);
e035b77a	289
b4aae759 FW	290	static int nft_meta_set_init_pkttype(const struct nft_ctx *ctx)
	291	{
	292	unsigned int hooks;
	293
	294	switch (ctx->afi->family) {
	295	case NFPROTO_BRIDGE:
	296	hooks = 1 << NF_BR_PRE_ROUTING;
	297	break;
	298	case NFPROTO_NETDEV:
	299	hooks = 1 << NF_NETDEV_INGRESS;
	300	break;
	301	default:
	302	return -EOPNOTSUPP;
	303	}
	304
	305	return nft_chain_validate_hooks(ctx->chain, hooks);
	306	}
	307
aa45660c TB	308	int nft_meta_set_init(const struct nft_ctx *ctx,
	309	const struct nft_expr *expr,
	310	const struct nlattr * const tb[])
e035b77a ABG	311	{
e035b77a ABG	312	struct nft_meta *priv = nft_expr_priv(expr);
d07db988	313	unsigned int len;
e035b77a ABG	314	int err;
	315
	316	priv->key = ntohl(nla_get_be32(tb[NFTA_META_KEY]));
d2caa696 PM	317	switch (priv->key) {
	318	case NFT_META_MARK:
	319	case NFT_META_PRIORITY:
d07db988 PM	320	len = sizeof(u32);
d07db988 PM	321	break;
d2caa696	322	case NFT_META_NFTRACE:
d07db988	323	len = sizeof(u8);
d2caa696	324	break;
b4aae759 FW	325	case NFT_META_PKTTYPE:
	326	err = nft_meta_set_init_pkttype(ctx);
	327	if (err)
	328	return err;
	329	len = sizeof(u8);
	330	break;
d2caa696 PM	331	default:
d2caa696 PM	332	return -EOPNOTSUPP;
e035b77a ABG	333	}
e035b77a ABG	334
b1c96ed3	335	priv->sreg = nft_parse_register(tb[NFTA_META_SREG]);
d07db988	336	err = nft_validate_register_load(priv->sreg, len);
b38895c5 PNA	337	if (err < 0)
b38895c5 PNA	338	return err;
e035b77a	339
e639f7ab FW	340	if (priv->key == NFT_META_NFTRACE)
	341	static_branch_inc(&nft_trace_enabled);
	342
e035b77a	343	return 0;
96518518	344	}
aa45660c	345	EXPORT_SYMBOL_GPL(nft_meta_set_init);
96518518	346
aa45660c TB	347	int nft_meta_get_dump(struct sk_buff *skb,
aa45660c TB	348	const struct nft_expr *expr)
96518518 PM	349	{
	350	const struct nft_meta *priv = nft_expr_priv(expr);
	351
e035b77a ABG	352	if (nla_put_be32(skb, NFTA_META_KEY, htonl(priv->key)))
e035b77a ABG	353	goto nla_put_failure;
b1c96ed3	354	if (nft_dump_register(skb, NFTA_META_DREG, priv->dreg))
96518518	355	goto nla_put_failure;
e035b77a ABG	356	return 0;
	357
	358	nla_put_failure:
	359	return -1;
	360	}
aa45660c	361	EXPORT_SYMBOL_GPL(nft_meta_get_dump);
e035b77a	362
aa45660c TB	363	int nft_meta_set_dump(struct sk_buff *skb,
aa45660c TB	364	const struct nft_expr *expr)
e035b77a ABG	365	{
	366	const struct nft_meta *priv = nft_expr_priv(expr);
	367
96518518 PM	368	if (nla_put_be32(skb, NFTA_META_KEY, htonl(priv->key)))
96518518 PM	369	goto nla_put_failure;
b1c96ed3	370	if (nft_dump_register(skb, NFTA_META_SREG, priv->sreg))
e035b77a ABG	371	goto nla_put_failure;
e035b77a ABG	372
96518518 PM	373	return 0;
	374
	375	nla_put_failure:
	376	return -1;
	377	}
aa45660c	378	EXPORT_SYMBOL_GPL(nft_meta_set_dump);
96518518	379
e639f7ab FW	380	void nft_meta_set_destroy(const struct nft_ctx *ctx,
	381	const struct nft_expr *expr)
	382	{
	383	const struct nft_meta *priv = nft_expr_priv(expr);
	384
	385	if (priv->key == NFT_META_NFTRACE)
	386	static_branch_dec(&nft_trace_enabled);
	387	}
	388	EXPORT_SYMBOL_GPL(nft_meta_set_destroy);
	389
ef1f7df9	390	static struct nft_expr_type nft_meta_type;
e035b77a	391	static const struct nft_expr_ops nft_meta_get_ops = {
ef1f7df9	392	.type = &nft_meta_type,
96518518	393	.size = NFT_EXPR_SIZE(sizeof(struct nft_meta)),
e035b77a	394	.eval = nft_meta_get_eval,
d2caa696	395	.init = nft_meta_get_init,
e035b77a	396	.dump = nft_meta_get_dump,
ef1f7df9 PM	397	};
ef1f7df9 PM	398
e035b77a ABG	399	static const struct nft_expr_ops nft_meta_set_ops = {
	400	.type = &nft_meta_type,
	401	.size = NFT_EXPR_SIZE(sizeof(struct nft_meta)),
	402	.eval = nft_meta_set_eval,
d2caa696	403	.init = nft_meta_set_init,
e639f7ab	404	.destroy = nft_meta_set_destroy,
e035b77a ABG	405	.dump = nft_meta_set_dump,
	406	};
	407
	408	static const struct nft_expr_ops *
	409	nft_meta_select_ops(const struct nft_ctx *ctx,
	410	const struct nlattr * const tb[])
	411	{
	412	if (tb[NFTA_META_KEY] == NULL)
	413	return ERR_PTR(-EINVAL);
	414
	415	if (tb[NFTA_META_DREG] && tb[NFTA_META_SREG])
	416	return ERR_PTR(-EINVAL);
	417
	418	if (tb[NFTA_META_DREG])
	419	return &nft_meta_get_ops;
	420
	421	if (tb[NFTA_META_SREG])
	422	return &nft_meta_set_ops;
	423
	424	return ERR_PTR(-EINVAL);
	425	}
	426
ef1f7df9 PM	427	static struct nft_expr_type nft_meta_type __read_mostly = {
ef1f7df9 PM	428	.name = "meta",
e035b77a	429	.select_ops = &nft_meta_select_ops,
96518518 PM	430	.policy = nft_meta_policy,
96518518 PM	431	.maxattr = NFTA_META_MAX,
ef1f7df9	432	.owner = THIS_MODULE,
96518518 PM	433	};
	434
	435	static int __init nft_meta_module_init(void)
	436	{
ef1f7df9	437	return nft_register_expr(&nft_meta_type);
96518518 PM	438	}
	439
	440	static void __exit nft_meta_module_exit(void)
	441	{
ef1f7df9	442	nft_unregister_expr(&nft_meta_type);
96518518 PM	443	}
	444
	445	module_init(nft_meta_module_init);
	446	module_exit(nft_meta_module_exit);
	447
	448	MODULE_LICENSE("GPL");
	449	MODULE_AUTHOR("Patrick McHardy <kaber@trash.net>");
	450	MODULE_ALIAS_NFT_EXPR("meta");