2 * net/sched/cls_matchll.c Match-all classifier
4 * Copyright (c) 2016 Jiri Pirko <jiri@mellanox.com>
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
12 #include <linux/kernel.h>
13 #include <linux/init.h>
14 #include <linux/module.h>
16 #include <net/sch_generic.h>
17 #include <net/pkt_cls.h>
19 struct cls_mall_filter {
21 struct tcf_result res;
27 struct cls_mall_head {
28 struct cls_mall_filter *filter;
32 static int mall_classify(struct sk_buff *skb, const struct tcf_proto *tp,
33 struct tcf_result *res)
35 struct cls_mall_head *head = rcu_dereference_bh(tp->root);
36 struct cls_mall_filter *f = head->filter;
38 if (tc_skip_sw(f->flags))
41 return tcf_exts_exec(skb, &f->exts, res);
44 static int mall_init(struct tcf_proto *tp)
46 struct cls_mall_head *head;
48 head = kzalloc(sizeof(*head), GFP_KERNEL);
52 rcu_assign_pointer(tp->root, head);
57 static void mall_destroy_filter(struct rcu_head *head)
59 struct cls_mall_filter *f = container_of(head, struct cls_mall_filter, rcu);
61 tcf_exts_destroy(&f->exts);
66 static int mall_replace_hw_filter(struct tcf_proto *tp,
67 struct cls_mall_filter *f,
70 struct net_device *dev = tp->q->dev_queue->dev;
71 struct tc_to_netdev offload;
72 struct tc_cls_matchall_offload mall_offload = {0};
74 offload.type = TC_SETUP_MATCHALL;
75 offload.cls_mall = &mall_offload;
76 offload.cls_mall->command = TC_CLSMATCHALL_REPLACE;
77 offload.cls_mall->exts = &f->exts;
78 offload.cls_mall->cookie = cookie;
80 return dev->netdev_ops->ndo_setup_tc(dev, tp->q->handle, tp->protocol,
84 static void mall_destroy_hw_filter(struct tcf_proto *tp,
85 struct cls_mall_filter *f,
88 struct net_device *dev = tp->q->dev_queue->dev;
89 struct tc_to_netdev offload;
90 struct tc_cls_matchall_offload mall_offload = {0};
92 offload.type = TC_SETUP_MATCHALL;
93 offload.cls_mall = &mall_offload;
94 offload.cls_mall->command = TC_CLSMATCHALL_DESTROY;
95 offload.cls_mall->exts = NULL;
96 offload.cls_mall->cookie = cookie;
98 dev->netdev_ops->ndo_setup_tc(dev, tp->q->handle, tp->protocol,
102 static bool mall_destroy(struct tcf_proto *tp, bool force)
104 struct cls_mall_head *head = rtnl_dereference(tp->root);
105 struct net_device *dev = tp->q->dev_queue->dev;
106 struct cls_mall_filter *f = head->filter;
112 if (tc_should_offload(dev, tp, f->flags))
113 mall_destroy_hw_filter(tp, f, (unsigned long) f);
115 call_rcu(&f->rcu, mall_destroy_filter);
117 kfree_rcu(head, rcu);
121 static unsigned long mall_get(struct tcf_proto *tp, u32 handle)
123 struct cls_mall_head *head = rtnl_dereference(tp->root);
124 struct cls_mall_filter *f = head->filter;
126 if (f && f->handle == handle)
127 return (unsigned long) f;
131 static const struct nla_policy mall_policy[TCA_MATCHALL_MAX + 1] = {
132 [TCA_MATCHALL_UNSPEC] = { .type = NLA_UNSPEC },
133 [TCA_MATCHALL_CLASSID] = { .type = NLA_U32 },
136 static int mall_set_parms(struct net *net, struct tcf_proto *tp,
137 struct cls_mall_filter *f,
138 unsigned long base, struct nlattr **tb,
139 struct nlattr *est, bool ovr)
144 tcf_exts_init(&e, TCA_MATCHALL_ACT, 0);
145 err = tcf_exts_validate(net, tp, tb, est, &e, ovr);
149 if (tb[TCA_MATCHALL_CLASSID]) {
150 f->res.classid = nla_get_u32(tb[TCA_MATCHALL_CLASSID]);
151 tcf_bind_filter(tp, &f->res, base);
154 tcf_exts_change(tp, &f->exts, &e);
159 static int mall_change(struct net *net, struct sk_buff *in_skb,
160 struct tcf_proto *tp, unsigned long base,
161 u32 handle, struct nlattr **tca,
162 unsigned long *arg, bool ovr)
164 struct cls_mall_head *head = rtnl_dereference(tp->root);
165 struct cls_mall_filter *fold = (struct cls_mall_filter *) *arg;
166 struct net_device *dev = tp->q->dev_queue->dev;
167 struct cls_mall_filter *f;
168 struct nlattr *tb[TCA_MATCHALL_MAX + 1];
172 if (!tca[TCA_OPTIONS])
181 err = nla_parse_nested(tb, TCA_MATCHALL_MAX,
182 tca[TCA_OPTIONS], mall_policy);
186 if (tb[TCA_MATCHALL_FLAGS]) {
187 flags = nla_get_u32(tb[TCA_MATCHALL_FLAGS]);
188 if (!tc_flags_valid(flags))
192 f = kzalloc(sizeof(*f), GFP_KERNEL);
196 tcf_exts_init(&f->exts, TCA_MATCHALL_ACT, 0);
203 err = mall_set_parms(net, tp, f, base, tb, tca[TCA_RATE], ovr);
207 if (tc_should_offload(dev, tp, flags)) {
208 err = mall_replace_hw_filter(tp, f, (unsigned long) f);
210 if (tc_skip_sw(flags))
217 *arg = (unsigned long) f;
218 rcu_assign_pointer(head->filter, f);
227 static int mall_delete(struct tcf_proto *tp, unsigned long arg)
229 struct cls_mall_head *head = rtnl_dereference(tp->root);
230 struct cls_mall_filter *f = (struct cls_mall_filter *) arg;
231 struct net_device *dev = tp->q->dev_queue->dev;
233 if (tc_should_offload(dev, tp, f->flags))
234 mall_destroy_hw_filter(tp, f, (unsigned long) f);
236 RCU_INIT_POINTER(head->filter, NULL);
237 tcf_unbind_filter(tp, &f->res);
238 call_rcu(&f->rcu, mall_destroy_filter);
242 static void mall_walk(struct tcf_proto *tp, struct tcf_walker *arg)
244 struct cls_mall_head *head = rtnl_dereference(tp->root);
245 struct cls_mall_filter *f = head->filter;
247 if (arg->count < arg->skip)
249 if (arg->fn(tp, (unsigned long) f, arg) < 0)
255 static int mall_dump(struct net *net, struct tcf_proto *tp, unsigned long fh,
256 struct sk_buff *skb, struct tcmsg *t)
258 struct cls_mall_filter *f = (struct cls_mall_filter *) fh;
264 t->tcm_handle = f->handle;
266 nest = nla_nest_start(skb, TCA_OPTIONS);
268 goto nla_put_failure;
270 if (f->res.classid &&
271 nla_put_u32(skb, TCA_MATCHALL_CLASSID, f->res.classid))
272 goto nla_put_failure;
274 if (tcf_exts_dump(skb, &f->exts))
275 goto nla_put_failure;
277 nla_nest_end(skb, nest);
279 if (tcf_exts_dump_stats(skb, &f->exts) < 0)
280 goto nla_put_failure;
285 nla_nest_cancel(skb, nest);
289 static struct tcf_proto_ops cls_mall_ops __read_mostly = {
291 .classify = mall_classify,
293 .destroy = mall_destroy,
295 .change = mall_change,
296 .delete = mall_delete,
299 .owner = THIS_MODULE,
302 static int __init cls_mall_init(void)
304 return register_tcf_proto_ops(&cls_mall_ops);
307 static void __exit cls_mall_exit(void)
309 unregister_tcf_proto_ops(&cls_mall_ops);
312 module_init(cls_mall_init);
313 module_exit(cls_mall_exit);
315 MODULE_AUTHOR("Jiri Pirko <jiri@mellanox.com>");
316 MODULE_DESCRIPTION("Match-all classifier");
317 MODULE_LICENSE("GPL v2");