[mirror_ubuntu-jammy-kernel.git] / net / sched / cls_matchall.c

// SPDX-License-Identifier: GPL-2.0-or-later
/*
 * net/sched/cls_matchll.c		Match-all classifier
 *
 * Copyright (c) 2016 Jiri Pirko <jiri@mellanox.com>
 */

#include <linux/kernel.h>
#include <linux/init.h>
#include <linux/module.h>
#include <linux/percpu.h>

#include <net/sch_generic.h>
#include <net/pkt_cls.h>

struct cls_mall_head {
	struct tcf_exts exts;
	struct tcf_result res;
	u32 handle;
	u32 flags;
	unsigned int in_hw_count;
	struct tc_matchall_pcnt __percpu *pf;
	struct rcu_work rwork;
	bool deleting;
};

static int mall_classify(struct sk_buff *skb, const struct tcf_proto *tp,
			 struct tcf_result *res)
{
	struct cls_mall_head *head = rcu_dereference_bh(tp->root);

	if (unlikely(!head))
		return -1;

	if (tc_skip_sw(head->flags))
		return -1;

	*res = head->res;
	__this_cpu_inc(head->pf->rhit);
	return tcf_exts_exec(skb, &head->exts, res);
}

static int mall_init(struct tcf_proto *tp)
{
	return 0;
}

static void __mall_destroy(struct cls_mall_head *head)
{
	tcf_exts_destroy(&head->exts);
	tcf_exts_put_net(&head->exts);
	free_percpu(head->pf);
	kfree(head);
}

static void mall_destroy_work(struct work_struct *work)
{
	struct cls_mall_head *head = container_of(to_rcu_work(work),
						  struct cls_mall_head,
						  rwork);
	rtnl_lock();
	__mall_destroy(head);
	rtnl_unlock();
}

static void mall_destroy_hw_filter(struct tcf_proto *tp,
				   struct cls_mall_head *head,
				   unsigned long cookie,
				   struct netlink_ext_ack *extack)
{
	struct tc_cls_matchall_offload cls_mall = {};
	struct tcf_block *block = tp->chain->block;

	tc_cls_common_offload_init(&cls_mall.common, tp, head->flags, extack);
	cls_mall.command = TC_CLSMATCHALL_DESTROY;
	cls_mall.cookie = cookie;

	tc_setup_cb_destroy(block, tp, TC_SETUP_CLSMATCHALL, &cls_mall, false,
			    &head->flags, &head->in_hw_count, true);
}

static int mall_replace_hw_filter(struct tcf_proto *tp,
				  struct cls_mall_head *head,
				  unsigned long cookie,
				  struct netlink_ext_ack *extack)
{
	struct tc_cls_matchall_offload cls_mall = {};
	struct tcf_block *block = tp->chain->block;
	bool skip_sw = tc_skip_sw(head->flags);
	int err;

	cls_mall.rule =	flow_rule_alloc(tcf_exts_num_actions(&head->exts));
	if (!cls_mall.rule)
		return -ENOMEM;

	tc_cls_common_offload_init(&cls_mall.common, tp, head->flags, extack);
	cls_mall.command = TC_CLSMATCHALL_REPLACE;
	cls_mall.cookie = cookie;

	err = tc_setup_flow_action(&cls_mall.rule->action, &head->exts);
	if (err) {
		kfree(cls_mall.rule);
		mall_destroy_hw_filter(tp, head, cookie, NULL);
		if (skip_sw)
			NL_SET_ERR_MSG_MOD(extack, "Failed to setup flow action");
		else
			err = 0;

		return err;
	}

	err = tc_setup_cb_add(block, tp, TC_SETUP_CLSMATCHALL, &cls_mall,
			      skip_sw, &head->flags, &head->in_hw_count, true);
	tc_cleanup_flow_action(&cls_mall.rule->action);
	kfree(cls_mall.rule);

	if (err) {
		mall_destroy_hw_filter(tp, head, cookie, NULL);
		return err;
	}

	if (skip_sw && !(head->flags & TCA_CLS_FLAGS_IN_HW))
		return -EINVAL;

	return 0;
}

static void mall_destroy(struct tcf_proto *tp, bool rtnl_held,
			 struct netlink_ext_ack *extack)
{
	struct cls_mall_head *head = rtnl_dereference(tp->root);

	if (!head)
		return;

	tcf_unbind_filter(tp, &head->res);

	if (!tc_skip_hw(head->flags))
		mall_destroy_hw_filter(tp, head, (unsigned long) head, extack);

	if (tcf_exts_get_net(&head->exts))
		tcf_queue_work(&head->rwork, mall_destroy_work);
	else
		__mall_destroy(head);
}

static void *mall_get(struct tcf_proto *tp, u32 handle)
{
	struct cls_mall_head *head = rtnl_dereference(tp->root);

	if (head && head->handle == handle)
		return head;

	return NULL;
}

static const struct nla_policy mall_policy[TCA_MATCHALL_MAX + 1] = {
	[TCA_MATCHALL_UNSPEC]		= { .type = NLA_UNSPEC },
	[TCA_MATCHALL_CLASSID]		= { .type = NLA_U32 },
	[TCA_MATCHALL_FLAGS]		= { .type = NLA_U32 },
};

static int mall_set_parms(struct net *net, struct tcf_proto *tp,
			  struct cls_mall_head *head,
			  unsigned long base, struct nlattr **tb,
			  struct nlattr *est, bool ovr,
			  struct netlink_ext_ack *extack)
{
	int err;

	err = tcf_exts_validate(net, tp, tb, est, &head->exts, ovr, true,
				extack);
	if (err < 0)
		return err;

	if (tb[TCA_MATCHALL_CLASSID]) {
		head->res.classid = nla_get_u32(tb[TCA_MATCHALL_CLASSID]);
		tcf_bind_filter(tp, &head->res, base);
	}
	return 0;
}

static int mall_change(struct net *net, struct sk_buff *in_skb,
		       struct tcf_proto *tp, unsigned long base,
		       u32 handle, struct nlattr **tca,
		       void **arg, bool ovr, bool rtnl_held,
		       struct netlink_ext_ack *extack)
{
	struct cls_mall_head *head = rtnl_dereference(tp->root);
	struct nlattr *tb[TCA_MATCHALL_MAX + 1];
	struct cls_mall_head *new;
	u32 flags = 0;
	int err;

	if (!tca[TCA_OPTIONS])
		return -EINVAL;

	if (head)
		return -EEXIST;

	err = nla_parse_nested_deprecated(tb, TCA_MATCHALL_MAX,
					  tca[TCA_OPTIONS], mall_policy, NULL);
	if (err < 0)
		return err;

	if (tb[TCA_MATCHALL_FLAGS]) {
		flags = nla_get_u32(tb[TCA_MATCHALL_FLAGS]);
		if (!tc_flags_valid(flags))
			return -EINVAL;
	}

	new = kzalloc(sizeof(*new), GFP_KERNEL);
	if (!new)
		return -ENOBUFS;

	err = tcf_exts_init(&new->exts, net, TCA_MATCHALL_ACT, 0);
	if (err)
		goto err_exts_init;

	if (!handle)
		handle = 1;
	new->handle = handle;
	new->flags = flags;
	new->pf = alloc_percpu(struct tc_matchall_pcnt);
	if (!new->pf) {
		err = -ENOMEM;
		goto err_alloc_percpu;
	}

	err = mall_set_parms(net, tp, new, base, tb, tca[TCA_RATE], ovr,
			     extack);
	if (err)
		goto err_set_parms;

	if (!tc_skip_hw(new->flags)) {
		err = mall_replace_hw_filter(tp, new, (unsigned long)new,
					     extack);
		if (err)
			goto err_replace_hw_filter;
	}

	if (!tc_in_hw(new->flags))
		new->flags |= TCA_CLS_FLAGS_NOT_IN_HW;

	*arg = head;
	rcu_assign_pointer(tp->root, new);
	return 0;

err_replace_hw_filter:
err_set_parms:
	free_percpu(new->pf);
err_alloc_percpu:
	tcf_exts_destroy(&new->exts);
err_exts_init:
	kfree(new);
	return err;
}

static int mall_delete(struct tcf_proto *tp, void *arg, bool *last,
		       bool rtnl_held, struct netlink_ext_ack *extack)
{
	struct cls_mall_head *head = rtnl_dereference(tp->root);

	head->deleting = true;
	*last = true;
	return 0;
}

static void mall_walk(struct tcf_proto *tp, struct tcf_walker *arg,
		      bool rtnl_held)
{
	struct cls_mall_head *head = rtnl_dereference(tp->root);

	if (arg->count < arg->skip)
		goto skip;

	if (!head || head->deleting)
		return;
	if (arg->fn(tp, head, arg) < 0)
		arg->stop = 1;
skip:
	arg->count++;
}

static int mall_reoffload(struct tcf_proto *tp, bool add, flow_setup_cb_t *cb,
			  void *cb_priv, struct netlink_ext_ack *extack)
{
	struct cls_mall_head *head = rtnl_dereference(tp->root);
	struct tc_cls_matchall_offload cls_mall = {};
	struct tcf_block *block = tp->chain->block;
	int err;

	if (tc_skip_hw(head->flags))
		return 0;

	cls_mall.rule =	flow_rule_alloc(tcf_exts_num_actions(&head->exts));
	if (!cls_mall.rule)
		return -ENOMEM;

	tc_cls_common_offload_init(&cls_mall.common, tp, head->flags, extack);
	cls_mall.command = add ?
		TC_CLSMATCHALL_REPLACE : TC_CLSMATCHALL_DESTROY;
	cls_mall.cookie = (unsigned long)head;

	err = tc_setup_flow_action(&cls_mall.rule->action, &head->exts);
	if (err) {
		kfree(cls_mall.rule);
		if (add && tc_skip_sw(head->flags)) {
			NL_SET_ERR_MSG_MOD(extack, "Failed to setup flow action");
			return err;
		}
		return 0;
	}

	err = tc_setup_cb_reoffload(block, tp, add, cb, TC_SETUP_CLSMATCHALL,
				    &cls_mall, cb_priv, &head->flags,
				    &head->in_hw_count);
	tc_cleanup_flow_action(&cls_mall.rule->action);
	kfree(cls_mall.rule);

	if (err)
		return err;

	return 0;
}

static void mall_stats_hw_filter(struct tcf_proto *tp,
				 struct cls_mall_head *head,
				 unsigned long cookie)
{
	struct tc_cls_matchall_offload cls_mall = {};
	struct tcf_block *block = tp->chain->block;

	tc_cls_common_offload_init(&cls_mall.common, tp, head->flags, NULL);
	cls_mall.command = TC_CLSMATCHALL_STATS;
	cls_mall.cookie = cookie;

	tc_setup_cb_call(block, TC_SETUP_CLSMATCHALL, &cls_mall, false, true);

	tcf_exts_stats_update(&head->exts, cls_mall.stats.bytes,
			      cls_mall.stats.pkts, cls_mall.stats.drops,
			      cls_mall.stats.lastused,
			      cls_mall.stats.used_hw_stats,
			      cls_mall.stats.used_hw_stats_valid);
}

static int mall_dump(struct net *net, struct tcf_proto *tp, void *fh,
		     struct sk_buff *skb, struct tcmsg *t, bool rtnl_held)
{
	struct tc_matchall_pcnt gpf = {};
	struct cls_mall_head *head = fh;
	struct nlattr *nest;
	int cpu;

	if (!head)
		return skb->len;

	if (!tc_skip_hw(head->flags))
		mall_stats_hw_filter(tp, head, (unsigned long)head);

	t->tcm_handle = head->handle;

	nest = nla_nest_start_noflag(skb, TCA_OPTIONS);
	if (!nest)
		goto nla_put_failure;

	if (head->res.classid &&
	    nla_put_u32(skb, TCA_MATCHALL_CLASSID, head->res.classid))
		goto nla_put_failure;

	if (head->flags && nla_put_u32(skb, TCA_MATCHALL_FLAGS, head->flags))
		goto nla_put_failure;

	for_each_possible_cpu(cpu) {
		struct tc_matchall_pcnt *pf = per_cpu_ptr(head->pf, cpu);

		gpf.rhit += pf->rhit;
	}

	if (nla_put_64bit(skb, TCA_MATCHALL_PCNT,
			  sizeof(struct tc_matchall_pcnt),
			  &gpf, TCA_MATCHALL_PAD))
		goto nla_put_failure;

	if (tcf_exts_dump(skb, &head->exts))
		goto nla_put_failure;

	nla_nest_end(skb, nest);

	if (tcf_exts_dump_stats(skb, &head->exts) < 0)
		goto nla_put_failure;

	return skb->len;

nla_put_failure:
	nla_nest_cancel(skb, nest);
	return -1;
}

static void mall_bind_class(void *fh, u32 classid, unsigned long cl, void *q,
			    unsigned long base)
{
	struct cls_mall_head *head = fh;

	if (head && head->res.classid == classid) {
		if (cl)
			__tcf_bind_filter(q, &head->res, base);
		else
			__tcf_unbind_filter(q, &head->res);
	}
}

static struct tcf_proto_ops cls_mall_ops __read_mostly = {
	.kind		= "matchall",
	.classify	= mall_classify,
	.init		= mall_init,
	.destroy	= mall_destroy,
	.get		= mall_get,
	.change		= mall_change,
	.delete		= mall_delete,
	.walk		= mall_walk,
	.reoffload	= mall_reoffload,
	.dump		= mall_dump,
	.bind_class	= mall_bind_class,
	.owner		= THIS_MODULE,
};

static int __init cls_mall_init(void)
{
	return register_tcf_proto_ops(&cls_mall_ops);
}

static void __exit cls_mall_exit(void)
{
	unregister_tcf_proto_ops(&cls_mall_ops);
}

module_init(cls_mall_init);
module_exit(cls_mall_exit);

MODULE_AUTHOR("Jiri Pirko <jiri@mellanox.com>");
MODULE_DESCRIPTION("Match-all classifier");
MODULE_LICENSE("GPL v2");
Commit	Line	Data
2874c5fd	1	// SPDX-License-Identifier: GPL-2.0-or-later
bf3994d2 JP	2	/*
	3	* net/sched/cls_matchll.c Match-all classifier
	4	*
	5	* Copyright (c) 2016 Jiri Pirko <jiri@mellanox.com>
bf3994d2 JP	6	*/
	7
	8	#include <linux/kernel.h>
	9	#include <linux/init.h>
	10	#include <linux/module.h>
f88c19aa	11	#include <linux/percpu.h>
bf3994d2 JP	12
	13	#include <net/sch_generic.h>
	14	#include <net/pkt_cls.h>
	15
fd62d9f5	16	struct cls_mall_head {
bf3994d2 JP	17	struct tcf_exts exts;
	18	struct tcf_result res;
	19	u32 handle;
b87f7936	20	u32 flags;
0efd1b3a	21	unsigned int in_hw_count;
f88c19aa	22	struct tc_matchall_pcnt __percpu *pf;
aaa908ff	23	struct rcu_work rwork;
f517f271	24	bool deleting;
bf3994d2 JP	25	};
	26
	27	static int mall_classify(struct sk_buff skb, const struct tcf_proto tp,
	28	struct tcf_result *res)
	29	{
	30	struct cls_mall_head *head = rcu_dereference_bh(tp->root);
bf3994d2	31
25426043 MC	32	if (unlikely(!head))
	33	return -1;
	34
fd62d9f5	35	if (tc_skip_sw(head->flags))
b87f7936 YG	36	return -1;
b87f7936 YG	37
3ff4cbec	38	*res = head->res;
f88c19aa	39	__this_cpu_inc(head->pf->rhit);
fd62d9f5	40	return tcf_exts_exec(skb, &head->exts, res);
bf3994d2 JP	41	}
	42
	43	static int mall_init(struct tcf_proto *tp)
	44	{
bf3994d2 JP	45	return 0;
	46	}
	47
57767e78 CW	48	static void __mall_destroy(struct cls_mall_head *head)
	49	{
	50	tcf_exts_destroy(&head->exts);
	51	tcf_exts_put_net(&head->exts);
f88c19aa	52	free_percpu(head->pf);
57767e78 CW	53	kfree(head);
	54	}
	55
df2735ee CW	56	static void mall_destroy_work(struct work_struct *work)
df2735ee CW	57	{
aaa908ff CW	58	struct cls_mall_head *head = container_of(to_rcu_work(work),
	59	struct cls_mall_head,
	60	rwork);
df2735ee	61	rtnl_lock();
57767e78	62	__mall_destroy(head);
df2735ee CW	63	rtnl_unlock();
	64	}
	65
2447a96f JP	66	static void mall_destroy_hw_filter(struct tcf_proto *tp,
2447a96f JP	67	struct cls_mall_head *head,
b505b29f JK	68	unsigned long cookie,
b505b29f JK	69	struct netlink_ext_ack *extack)
b87f7936	70	{
de4784ca	71	struct tc_cls_matchall_offload cls_mall = {};
2447a96f	72	struct tcf_block *block = tp->chain->block;
b87f7936	73
d6787147	74	tc_cls_common_offload_init(&cls_mall.common, tp, head->flags, extack);
2447a96f	75	cls_mall.command = TC_CLSMATCHALL_DESTROY;
de4784ca	76	cls_mall.cookie = cookie;
b87f7936	77
40119211 VB	78	tc_setup_cb_destroy(block, tp, TC_SETUP_CLSMATCHALL, &cls_mall, false,
40119211 VB	79	&head->flags, &head->in_hw_count, true);
b87f7936 YG	80	}
b87f7936 YG	81
2447a96f JP	82	static int mall_replace_hw_filter(struct tcf_proto *tp,
2447a96f JP	83	struct cls_mall_head *head,
02798140 QM	84	unsigned long cookie,
02798140 QM	85	struct netlink_ext_ack *extack)
b87f7936	86	{
de4784ca	87	struct tc_cls_matchall_offload cls_mall = {};
2447a96f JP	88	struct tcf_block *block = tp->chain->block;
	89	bool skip_sw = tc_skip_sw(head->flags);
	90	int err;
b87f7936	91
f00cbf19 PJV	92	cls_mall.rule = flow_rule_alloc(tcf_exts_num_actions(&head->exts));
	93	if (!cls_mall.rule)
	94	return -ENOMEM;
	95
d6787147	96	tc_cls_common_offload_init(&cls_mall.common, tp, head->flags, extack);
2447a96f	97	cls_mall.command = TC_CLSMATCHALL_REPLACE;
de4784ca	98	cls_mall.cookie = cookie;
b87f7936	99
b15e7a6e	100	err = tc_setup_flow_action(&cls_mall.rule->action, &head->exts);
f00cbf19 PJV	101	if (err) {
	102	kfree(cls_mall.rule);
	103	mall_destroy_hw_filter(tp, head, cookie, NULL);
	104	if (skip_sw)
	105	NL_SET_ERR_MSG_MOD(extack, "Failed to setup flow action");
	106	else
	107	err = 0;
	108
	109	return err;
	110	}
	111
40119211 VB	112	err = tc_setup_cb_add(block, tp, TC_SETUP_CLSMATCHALL, &cls_mall,
40119211 VB	113	skip_sw, &head->flags, &head->in_hw_count, true);
f2b795ea	114	tc_cleanup_flow_action(&cls_mall.rule->action);
f00cbf19 PJV	115	kfree(cls_mall.rule);
f00cbf19 PJV	116
40119211	117	if (err) {
b505b29f	118	mall_destroy_hw_filter(tp, head, cookie, NULL);
2447a96f	119	return err;
2447a96f JP	120	}
	121
	122	if (skip_sw && !(head->flags & TCA_CLS_FLAGS_IN_HW))
	123	return -EINVAL;
	124
	125	return 0;
b87f7936 YG	126	}
b87f7936 YG	127
12db03b6 VB	128	static void mall_destroy(struct tcf_proto *tp, bool rtnl_held,
12db03b6 VB	129	struct netlink_ext_ack *extack)
bf3994d2 JP	130	{
	131	struct cls_mall_head *head = rtnl_dereference(tp->root);
	132
fd62d9f5	133	if (!head)
763dbf63	134	return;
bf3994d2	135
a51c76b4 HL	136	tcf_unbind_filter(tp, &head->res);
a51c76b4 HL	137
2447a96f	138	if (!tc_skip_hw(head->flags))
b505b29f	139	mall_destroy_hw_filter(tp, head, (unsigned long) head, extack);
b87f7936	140
57767e78	141	if (tcf_exts_get_net(&head->exts))
aaa908ff	142	tcf_queue_work(&head->rwork, mall_destroy_work);
57767e78 CW	143	else
57767e78 CW	144	__mall_destroy(head);
bf3994d2 JP	145	}
bf3994d2 JP	146
8113c095	147	static void mall_get(struct tcf_proto tp, u32 handle)
bf3994d2	148	{
0db6f8be ND	149	struct cls_mall_head *head = rtnl_dereference(tp->root);
	150
	151	if (head && head->handle == handle)
	152	return head;
	153
8113c095	154	return NULL;
bf3994d2 JP	155	}
	156
	157	static const struct nla_policy mall_policy[TCA_MATCHALL_MAX + 1] = {
	158	[TCA_MATCHALL_UNSPEC] = { .type = NLA_UNSPEC },
	159	[TCA_MATCHALL_CLASSID] = { .type = NLA_U32 },
1afa3cc9	160	[TCA_MATCHALL_FLAGS] = { .type = NLA_U32 },
bf3994d2 JP	161	};
	162
	163	static int mall_set_parms(struct net net, struct tcf_proto tp,
fd62d9f5	164	struct cls_mall_head *head,
bf3994d2	165	unsigned long base, struct nlattr **tb,
50a56190 AA	166	struct nlattr *est, bool ovr,
50a56190 AA	167	struct netlink_ext_ack *extack)
bf3994d2	168	{
bf3994d2 JP	169	int err;
bf3994d2 JP	170
ec6743a1 VB	171	err = tcf_exts_validate(net, tp, tb, est, &head->exts, ovr, true,
ec6743a1 VB	172	extack);
bf3994d2	173	if (err < 0)
a74cb369	174	return err;
bf3994d2 JP	175
bf3994d2 JP	176	if (tb[TCA_MATCHALL_CLASSID]) {
fd62d9f5 YG	177	head->res.classid = nla_get_u32(tb[TCA_MATCHALL_CLASSID]);
fd62d9f5 YG	178	tcf_bind_filter(tp, &head->res, base);
bf3994d2	179	}
bf3994d2 JP	180	return 0;
	181	}
	182
	183	static int mall_change(struct net net, struct sk_buff in_skb,
	184	struct tcf_proto *tp, unsigned long base,
	185	u32 handle, struct nlattr **tca,
12db03b6 VB	186	void **arg, bool ovr, bool rtnl_held,
12db03b6 VB	187	struct netlink_ext_ack *extack)
bf3994d2 JP	188	{
bf3994d2 JP	189	struct cls_mall_head *head = rtnl_dereference(tp->root);
bf3994d2	190	struct nlattr *tb[TCA_MATCHALL_MAX + 1];
fd62d9f5	191	struct cls_mall_head *new;
b87f7936	192	u32 flags = 0;
bf3994d2 JP	193	int err;
	194
	195	if (!tca[TCA_OPTIONS])
	196	return -EINVAL;
	197
fd62d9f5 YG	198	if (head)
fd62d9f5 YG	199	return -EEXIST;
bf3994d2	200
8cb08174 JB	201	err = nla_parse_nested_deprecated(tb, TCA_MATCHALL_MAX,
8cb08174 JB	202	tca[TCA_OPTIONS], mall_policy, NULL);
bf3994d2 JP	203	if (err < 0)
	204	return err;
	205
b87f7936 YG	206	if (tb[TCA_MATCHALL_FLAGS]) {
	207	flags = nla_get_u32(tb[TCA_MATCHALL_FLAGS]);
	208	if (!tc_flags_valid(flags))
	209	return -EINVAL;
	210	}
	211
fd62d9f5 YG	212	new = kzalloc(sizeof(*new), GFP_KERNEL);
fd62d9f5 YG	213	if (!new)
bf3994d2 JP	214	return -ENOBUFS;
bf3994d2 JP	215
14215108	216	err = tcf_exts_init(&new->exts, net, TCA_MATCHALL_ACT, 0);
ec2507d2 YG	217	if (err)
ec2507d2 YG	218	goto err_exts_init;
bf3994d2 JP	219
	220	if (!handle)
	221	handle = 1;
fd62d9f5 YG	222	new->handle = handle;
fd62d9f5 YG	223	new->flags = flags;
f88c19aa CW	224	new->pf = alloc_percpu(struct tc_matchall_pcnt);
	225	if (!new->pf) {
	226	err = -ENOMEM;
	227	goto err_alloc_percpu;
	228	}
bf3994d2	229
50a56190 AA	230	err = mall_set_parms(net, tp, new, base, tb, tca[TCA_RATE], ovr,
50a56190 AA	231	extack);
bf3994d2	232	if (err)
ec2507d2	233	goto err_set_parms;
bf3994d2	234
2447a96f	235	if (!tc_skip_hw(new->flags)) {
02798140 QM	236	err = mall_replace_hw_filter(tp, new, (unsigned long)new,
02798140 QM	237	extack);
2447a96f JP	238	if (err)
2447a96f JP	239	goto err_replace_hw_filter;
b87f7936	240	}
c7d2b2f5 OG	241
	242	if (!tc_in_hw(new->flags))
	243	new->flags \|= TCA_CLS_FLAGS_NOT_IN_HW;
b87f7936	244
8113c095	245	*arg = head;
fd62d9f5	246	rcu_assign_pointer(tp->root, new);
bf3994d2 JP	247	return 0;
bf3994d2 JP	248
ec2507d2 YG	249	err_replace_hw_filter:
ec2507d2 YG	250	err_set_parms:
f88c19aa CW	251	free_percpu(new->pf);
f88c19aa CW	252	err_alloc_percpu:
e2160156	253	tcf_exts_destroy(&new->exts);
ec2507d2	254	err_exts_init:
fd62d9f5	255	kfree(new);
bf3994d2 JP	256	return err;
	257	}
	258
571acf21	259	static int mall_delete(struct tcf_proto tp, void arg, bool *last,
12db03b6	260	bool rtnl_held, struct netlink_ext_ack *extack)
bf3994d2	261	{
f517f271 JP	262	struct cls_mall_head *head = rtnl_dereference(tp->root);
	263
	264	head->deleting = true;
	265	*last = true;
	266	return 0;
bf3994d2 JP	267	}
bf3994d2 JP	268
12db03b6 VB	269	static void mall_walk(struct tcf_proto tp, struct tcf_walker arg,
12db03b6 VB	270	bool rtnl_held)
bf3994d2 JP	271	{
bf3994d2 JP	272	struct cls_mall_head *head = rtnl_dereference(tp->root);
bf3994d2 JP	273
	274	if (arg->count < arg->skip)
	275	goto skip;
d66022cd	276
f517f271	277	if (!head \|\| head->deleting)
d66022cd	278	return;
8113c095	279	if (arg->fn(tp, head, arg) < 0)
bf3994d2 JP	280	arg->stop = 1;
	281	skip:
	282	arg->count++;
	283	}
	284
a7323311	285	static int mall_reoffload(struct tcf_proto tp, bool add, flow_setup_cb_t cb,
0efd1b3a JH	286	void cb_priv, struct netlink_ext_ack extack)
	287	{
	288	struct cls_mall_head *head = rtnl_dereference(tp->root);
	289	struct tc_cls_matchall_offload cls_mall = {};
	290	struct tcf_block *block = tp->chain->block;
	291	int err;
	292
	293	if (tc_skip_hw(head->flags))
	294	return 0;
	295
f00cbf19 PJV	296	cls_mall.rule = flow_rule_alloc(tcf_exts_num_actions(&head->exts));
	297	if (!cls_mall.rule)
	298	return -ENOMEM;
	299
d6787147	300	tc_cls_common_offload_init(&cls_mall.common, tp, head->flags, extack);
0efd1b3a JH	301	cls_mall.command = add ?
0efd1b3a JH	302	TC_CLSMATCHALL_REPLACE : TC_CLSMATCHALL_DESTROY;
0efd1b3a JH	303	cls_mall.cookie = (unsigned long)head;
0efd1b3a JH	304
b15e7a6e	305	err = tc_setup_flow_action(&cls_mall.rule->action, &head->exts);
f00cbf19 PJV	306	if (err) {
	307	kfree(cls_mall.rule);
	308	if (add && tc_skip_sw(head->flags)) {
	309	NL_SET_ERR_MSG_MOD(extack, "Failed to setup flow action");
	310	return err;
	311	}
5f058368	312	return 0;
f00cbf19 PJV	313	}
f00cbf19 PJV	314
40119211 VB	315	err = tc_setup_cb_reoffload(block, tp, add, cb, TC_SETUP_CLSMATCHALL,
	316	&cls_mall, cb_priv, &head->flags,
	317	&head->in_hw_count);
f2b795ea	318	tc_cleanup_flow_action(&cls_mall.rule->action);
f00cbf19 PJV	319	kfree(cls_mall.rule);
f00cbf19 PJV	320
40119211 VB	321	if (err)
40119211 VB	322	return err;
0efd1b3a JH	323
	324	return 0;
	325	}
	326
b7fe4ab8 PJV	327	static void mall_stats_hw_filter(struct tcf_proto *tp,
	328	struct cls_mall_head *head,
	329	unsigned long cookie)
	330	{
	331	struct tc_cls_matchall_offload cls_mall = {};
	332	struct tcf_block *block = tp->chain->block;
	333
d6787147	334	tc_cls_common_offload_init(&cls_mall.common, tp, head->flags, NULL);
b7fe4ab8 PJV	335	cls_mall.command = TC_CLSMATCHALL_STATS;
	336	cls_mall.cookie = cookie;
	337
40119211	338	tc_setup_cb_call(block, TC_SETUP_CLSMATCHALL, &cls_mall, false, true);
b7fe4ab8 PJV	339
b7fe4ab8 PJV	340	tcf_exts_stats_update(&head->exts, cls_mall.stats.bytes,
4b61d3e8 PL	341	cls_mall.stats.pkts, cls_mall.stats.drops,
4b61d3e8 PL	342	cls_mall.stats.lastused,
93a129eb JP	343	cls_mall.stats.used_hw_stats,
93a129eb JP	344	cls_mall.stats.used_hw_stats_valid);
b7fe4ab8 PJV	345	}
b7fe4ab8 PJV	346
8113c095	347	static int mall_dump(struct net net, struct tcf_proto tp, void *fh,
12db03b6	348	struct sk_buff skb, struct tcmsg t, bool rtnl_held)
bf3994d2	349	{
f88c19aa	350	struct tc_matchall_pcnt gpf = {};
8113c095	351	struct cls_mall_head *head = fh;
bf3994d2	352	struct nlattr *nest;
f88c19aa	353	int cpu;
bf3994d2	354
fd62d9f5	355	if (!head)
bf3994d2 JP	356	return skb->len;
bf3994d2 JP	357
b7fe4ab8 PJV	358	if (!tc_skip_hw(head->flags))
	359	mall_stats_hw_filter(tp, head, (unsigned long)head);
	360
fd62d9f5	361	t->tcm_handle = head->handle;
bf3994d2	362
ae0be8de	363	nest = nla_nest_start_noflag(skb, TCA_OPTIONS);
bf3994d2 JP	364	if (!nest)
	365	goto nla_put_failure;
	366
fd62d9f5 YG	367	if (head->res.classid &&
fd62d9f5 YG	368	nla_put_u32(skb, TCA_MATCHALL_CLASSID, head->res.classid))
bf3994d2 JP	369	goto nla_put_failure;
bf3994d2 JP	370
7a335ada OG	371	if (head->flags && nla_put_u32(skb, TCA_MATCHALL_FLAGS, head->flags))
	372	goto nla_put_failure;
	373
f88c19aa CW	374	for_each_possible_cpu(cpu) {
	375	struct tc_matchall_pcnt *pf = per_cpu_ptr(head->pf, cpu);
	376
	377	gpf.rhit += pf->rhit;
	378	}
	379
	380	if (nla_put_64bit(skb, TCA_MATCHALL_PCNT,
	381	sizeof(struct tc_matchall_pcnt),
	382	&gpf, TCA_MATCHALL_PAD))
	383	goto nla_put_failure;
	384
fd62d9f5	385	if (tcf_exts_dump(skb, &head->exts))
bf3994d2 JP	386	goto nla_put_failure;
	387
	388	nla_nest_end(skb, nest);
	389
fd62d9f5	390	if (tcf_exts_dump_stats(skb, &head->exts) < 0)
bf3994d2 JP	391	goto nla_put_failure;
	392
	393	return skb->len;
	394
	395	nla_put_failure:
	396	nla_nest_cancel(skb, nest);
	397	return -1;
	398	}
	399
2e24cd75 CW	400	static void mall_bind_class(void fh, u32 classid, unsigned long cl, void q,
2e24cd75 CW	401	unsigned long base)
07d79fc7 CW	402	{
	403	struct cls_mall_head *head = fh;
	404
2e24cd75 CW	405	if (head && head->res.classid == classid) {
	406	if (cl)
	407	__tcf_bind_filter(q, &head->res, base);
	408	else
	409	__tcf_unbind_filter(q, &head->res);
	410	}
07d79fc7 CW	411	}
07d79fc7 CW	412
bf3994d2 JP	413	static struct tcf_proto_ops cls_mall_ops __read_mostly = {
	414	.kind = "matchall",
	415	.classify = mall_classify,
	416	.init = mall_init,
	417	.destroy = mall_destroy,
	418	.get = mall_get,
	419	.change = mall_change,
	420	.delete = mall_delete,
	421	.walk = mall_walk,
0efd1b3a	422	.reoffload = mall_reoffload,
bf3994d2	423	.dump = mall_dump,
07d79fc7	424	.bind_class = mall_bind_class,
bf3994d2 JP	425	.owner = THIS_MODULE,
	426	};
	427
	428	static int __init cls_mall_init(void)
	429	{
	430	return register_tcf_proto_ops(&cls_mall_ops);
	431	}
	432
	433	static void __exit cls_mall_exit(void)
	434	{
	435	unregister_tcf_proto_ops(&cls_mall_ops);
	436	}
	437
	438	module_init(cls_mall_init);
	439	module_exit(cls_mall_exit);
	440
	441	MODULE_AUTHOR("Jiri Pirko <jiri@mellanox.com>");
	442	MODULE_DESCRIPTION("Match-all classifier");
	443	MODULE_LICENSE("GPL v2");