blob: a7c5645373afb02a90d2ad76595e6dfcf14fe6b7 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * net/sched/cls_api.c Packet classifier API.
3 *
4 * This program is free software; you can redistribute it and/or
5 * modify it under the terms of the GNU General Public License
6 * as published by the Free Software Foundation; either version
7 * 2 of the License, or (at your option) any later version.
8 *
9 * Authors: Alexey Kuznetsov, <kuznet@ms2.inr.ac.ru>
10 *
11 * Changes:
12 *
13 * Eduardo J. Blanco <ejbs@netlabs.com.uy> :990222: kmod support
14 *
15 */
16
Linus Torvalds1da177e2005-04-16 15:20:36 -070017#include <linux/module.h>
18#include <linux/types.h>
19#include <linux/kernel.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070020#include <linux/string.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070021#include <linux/errno.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070022#include <linux/skbuff.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070023#include <linux/init.h>
24#include <linux/kmod.h>
Patrick McHardyab27cfb2008-01-23 20:33:13 -080025#include <linux/err.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090026#include <linux/slab.h>
Denis V. Lunevb8542722007-12-01 00:21:31 +110027#include <net/net_namespace.h>
28#include <net/sock.h>
Arnaldo Carvalho de Melodc5fc572007-03-25 23:06:12 -070029#include <net/netlink.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070030#include <net/pkt_sched.h>
31#include <net/pkt_cls.h>
32
Linus Torvalds1da177e2005-04-16 15:20:36 -070033/* The list of all installed classifier types */
WANG Cong36272872013-12-15 20:15:11 -080034static LIST_HEAD(tcf_proto_base);
Linus Torvalds1da177e2005-04-16 15:20:36 -070035
36/* Protects list of registered TC modules. It is pure SMP lock. */
37static DEFINE_RWLOCK(cls_mod_lock);
38
39/* Find classifier type by string name */
40
Eric Dumazetdc7f9f62011-07-05 23:25:42 +000041static const struct tcf_proto_ops *tcf_proto_lookup_ops(struct nlattr *kind)
Linus Torvalds1da177e2005-04-16 15:20:36 -070042{
Eric Dumazetdcd76082013-12-20 10:04:18 -080043 const struct tcf_proto_ops *t, *res = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -070044
45 if (kind) {
46 read_lock(&cls_mod_lock);
WANG Cong36272872013-12-15 20:15:11 -080047 list_for_each_entry(t, &tcf_proto_base, head) {
Patrick McHardyadd93b62008-01-22 22:11:33 -080048 if (nla_strcmp(kind, t->kind) == 0) {
Eric Dumazetdcd76082013-12-20 10:04:18 -080049 if (try_module_get(t->owner))
50 res = t;
Linus Torvalds1da177e2005-04-16 15:20:36 -070051 break;
52 }
53 }
54 read_unlock(&cls_mod_lock);
55 }
Eric Dumazetdcd76082013-12-20 10:04:18 -080056 return res;
Linus Torvalds1da177e2005-04-16 15:20:36 -070057}
58
59/* Register(unregister) new classifier type */
60
61int register_tcf_proto_ops(struct tcf_proto_ops *ops)
62{
WANG Cong36272872013-12-15 20:15:11 -080063 struct tcf_proto_ops *t;
Linus Torvalds1da177e2005-04-16 15:20:36 -070064 int rc = -EEXIST;
65
66 write_lock(&cls_mod_lock);
WANG Cong36272872013-12-15 20:15:11 -080067 list_for_each_entry(t, &tcf_proto_base, head)
Linus Torvalds1da177e2005-04-16 15:20:36 -070068 if (!strcmp(ops->kind, t->kind))
69 goto out;
70
WANG Cong36272872013-12-15 20:15:11 -080071 list_add_tail(&ops->head, &tcf_proto_base);
Linus Torvalds1da177e2005-04-16 15:20:36 -070072 rc = 0;
73out:
74 write_unlock(&cls_mod_lock);
75 return rc;
76}
Stephen Hemmingeraa767bf2008-01-21 02:26:41 -080077EXPORT_SYMBOL(register_tcf_proto_ops);
Linus Torvalds1da177e2005-04-16 15:20:36 -070078
79int unregister_tcf_proto_ops(struct tcf_proto_ops *ops)
80{
WANG Cong36272872013-12-15 20:15:11 -080081 struct tcf_proto_ops *t;
Linus Torvalds1da177e2005-04-16 15:20:36 -070082 int rc = -ENOENT;
83
Daniel Borkmannc78e1742015-05-20 17:13:33 +020084 /* Wait for outstanding call_rcu()s, if any, from a
85 * tcf_proto_ops's destroy() handler.
86 */
87 rcu_barrier();
88
Linus Torvalds1da177e2005-04-16 15:20:36 -070089 write_lock(&cls_mod_lock);
Eric Dumazetdcd76082013-12-20 10:04:18 -080090 list_for_each_entry(t, &tcf_proto_base, head) {
91 if (t == ops) {
92 list_del(&t->head);
93 rc = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -070094 break;
Eric Dumazetdcd76082013-12-20 10:04:18 -080095 }
96 }
Linus Torvalds1da177e2005-04-16 15:20:36 -070097 write_unlock(&cls_mod_lock);
98 return rc;
99}
Stephen Hemmingeraa767bf2008-01-21 02:26:41 -0800100EXPORT_SYMBOL(unregister_tcf_proto_ops);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700101
Tom Goff7316ae82010-03-19 15:40:13 +0000102static int tfilter_notify(struct net *net, struct sk_buff *oskb,
103 struct nlmsghdr *n, struct tcf_proto *tp,
104 unsigned long fh, int event);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700105
Daniel Borkmannea7f8272016-06-10 23:10:22 +0200106static void tfilter_notify_chain(struct net *net, struct sk_buff *oskb,
107 struct nlmsghdr *n,
108 struct tcf_proto __rcu **chain, int event)
109{
110 struct tcf_proto __rcu **it_chain;
111 struct tcf_proto *tp;
112
113 for (it_chain = chain; (tp = rtnl_dereference(*it_chain)) != NULL;
114 it_chain = &tp->next)
115 tfilter_notify(net, oskb, n, tp, 0, event);
116}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700117
118/* Select new prio value from the range, managed by kernel. */
119
Stephen Hemmingeraa767bf2008-01-21 02:26:41 -0800120static inline u32 tcf_auto_prio(struct tcf_proto *tp)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700121{
Stephen Hemmingeraa767bf2008-01-21 02:26:41 -0800122 u32 first = TC_H_MAKE(0xC0000000U, 0U);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700123
124 if (tp)
Eric Dumazetcc7ec452011-01-19 19:26:56 +0000125 first = tp->prio - 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700126
127 return first;
128}
129
130/* Add/change/delete/get a filter node */
131
Thomas Graf661d2962013-03-21 07:45:29 +0000132static int tc_ctl_tfilter(struct sk_buff *skb, struct nlmsghdr *n)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700133{
YOSHIFUJI Hideaki3b1e0a62008-03-26 02:26:21 +0900134 struct net *net = sock_net(skb->sk);
Patrick McHardyadd93b62008-01-22 22:11:33 -0800135 struct nlattr *tca[TCA_MAX + 1];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700136 struct tcmsg *t;
137 u32 protocol;
138 u32 prio;
139 u32 nprio;
140 u32 parent;
141 struct net_device *dev;
142 struct Qdisc *q;
John Fastabend25d8c0d2014-09-12 20:05:27 -0700143 struct tcf_proto __rcu **back;
144 struct tcf_proto __rcu **chain;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700145 struct tcf_proto *tp;
Eric Dumazetdc7f9f62011-07-05 23:25:42 +0000146 const struct tcf_proto_ops *tp_ops;
Eric Dumazet20fea082007-11-14 01:44:41 -0800147 const struct Qdisc_class_ops *cops;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700148 unsigned long cl;
149 unsigned long fh;
150 int err;
Minoru Usui12186be2009-06-02 02:17:34 -0700151 int tp_created = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700152
Stéphane Graber4e8bbb82014-04-30 11:25:43 -0400153 if ((n->nlmsg_type != RTM_GETTFILTER) &&
David S. Miller5f013c9b2014-05-12 13:19:14 -0400154 !netlink_ns_capable(skb, net->user_ns, CAP_NET_ADMIN))
Eric W. Biedermandfc47ef2012-11-16 03:03:00 +0000155 return -EPERM;
Hong zhi guode179c82013-03-25 17:36:33 +0000156
Linus Torvalds1da177e2005-04-16 15:20:36 -0700157replay:
Hong zhi guode179c82013-03-25 17:36:33 +0000158 err = nlmsg_parse(n, sizeof(*t), tca, TCA_MAX, NULL);
159 if (err < 0)
160 return err;
161
David S. Miller942b8162012-06-26 21:48:50 -0700162 t = nlmsg_data(n);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700163 protocol = TC_H_MIN(t->tcm_info);
164 prio = TC_H_MAJ(t->tcm_info);
165 nprio = prio;
166 parent = t->tcm_parent;
167 cl = 0;
168
169 if (prio == 0) {
Daniel Borkmannea7f8272016-06-10 23:10:22 +0200170 switch (n->nlmsg_type) {
171 case RTM_DELTFILTER:
Daniel Borkmann9f6ed032016-06-16 23:19:29 +0200172 if (protocol || t->tcm_handle || tca[TCA_KIND])
Daniel Borkmannea7f8272016-06-10 23:10:22 +0200173 return -ENOENT;
174 break;
175 case RTM_NEWTFILTER:
176 /* If no priority is provided by the user,
177 * we allocate one.
178 */
179 if (n->nlmsg_flags & NLM_F_CREATE) {
180 prio = TC_H_MAKE(0x80000000U, 0U);
181 break;
182 }
183 /* fall-through */
184 default:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700185 return -ENOENT;
Daniel Borkmannea7f8272016-06-10 23:10:22 +0200186 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700187 }
188
189 /* Find head of filter chain. */
190
191 /* Find link */
Tom Goff7316ae82010-03-19 15:40:13 +0000192 dev = __dev_get_by_index(net, t->tcm_ifindex);
Stephen Hemmingeraa767bf2008-01-21 02:26:41 -0800193 if (dev == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700194 return -ENODEV;
195
196 /* Find qdisc */
197 if (!parent) {
Patrick McHardyaf356af2009-09-04 06:41:18 +0000198 q = dev->qdisc;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700199 parent = q->handle;
Stephen Hemmingeraa767bf2008-01-21 02:26:41 -0800200 } else {
201 q = qdisc_lookup(dev, TC_H_MAJ(t->tcm_parent));
202 if (q == NULL)
203 return -EINVAL;
204 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700205
206 /* Is it classful? */
Eric Dumazetcc7ec452011-01-19 19:26:56 +0000207 cops = q->ops->cl_ops;
208 if (!cops)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700209 return -EINVAL;
210
Patrick McHardy71ebe5e2009-09-04 06:41:15 +0000211 if (cops->tcf_chain == NULL)
212 return -EOPNOTSUPP;
213
Linus Torvalds1da177e2005-04-16 15:20:36 -0700214 /* Do we search for filter, attached to class? */
215 if (TC_H_MIN(parent)) {
216 cl = cops->get(q, parent);
217 if (cl == 0)
218 return -ENOENT;
219 }
220
221 /* And the last stroke */
222 chain = cops->tcf_chain(q, cl);
223 err = -EINVAL;
224 if (chain == NULL)
225 goto errout;
Daniel Borkmannea7f8272016-06-10 23:10:22 +0200226 if (n->nlmsg_type == RTM_DELTFILTER && prio == 0) {
227 tfilter_notify_chain(net, skb, n, chain, RTM_DELTFILTER);
228 tcf_destroy_chain(chain);
229 err = 0;
230 goto errout;
231 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700232
233 /* Check the chain for existence of proto-tcf with this priority */
John Fastabend25d8c0d2014-09-12 20:05:27 -0700234 for (back = chain;
235 (tp = rtnl_dereference(*back)) != NULL;
236 back = &tp->next) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700237 if (tp->prio >= prio) {
238 if (tp->prio == prio) {
Eric Dumazetcc7ec452011-01-19 19:26:56 +0000239 if (!nprio ||
240 (tp->protocol != protocol && protocol))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700241 goto errout;
242 } else
243 tp = NULL;
244 break;
245 }
246 }
247
248 if (tp == NULL) {
249 /* Proto-tcf does not exist, create new one */
250
Patrick McHardyadd93b62008-01-22 22:11:33 -0800251 if (tca[TCA_KIND] == NULL || !protocol)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700252 goto errout;
253
254 err = -ENOENT;
Eric Dumazetcc7ec452011-01-19 19:26:56 +0000255 if (n->nlmsg_type != RTM_NEWTFILTER ||
256 !(n->nlmsg_flags & NLM_F_CREATE))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700257 goto errout;
258
259
260 /* Create new proto tcf */
261
262 err = -ENOBUFS;
Stephen Hemmingeraa767bf2008-01-21 02:26:41 -0800263 tp = kzalloc(sizeof(*tp), GFP_KERNEL);
264 if (tp == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700265 goto errout;
Patrick McHardyf2df8242008-05-20 14:34:46 -0700266 err = -ENOENT;
Patrick McHardyadd93b62008-01-22 22:11:33 -0800267 tp_ops = tcf_proto_lookup_ops(tca[TCA_KIND]);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700268 if (tp_ops == NULL) {
Johannes Berg95a5afc2008-10-16 15:24:51 -0700269#ifdef CONFIG_MODULES
Patrick McHardyadd93b62008-01-22 22:11:33 -0800270 struct nlattr *kind = tca[TCA_KIND];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700271 char name[IFNAMSIZ];
272
273 if (kind != NULL &&
Patrick McHardyadd93b62008-01-22 22:11:33 -0800274 nla_strlcpy(name, kind, IFNAMSIZ) < IFNAMSIZ) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700275 rtnl_unlock();
276 request_module("cls_%s", name);
277 rtnl_lock();
278 tp_ops = tcf_proto_lookup_ops(kind);
279 /* We dropped the RTNL semaphore in order to
280 * perform the module load. So, even if we
281 * succeeded in loading the module we have to
282 * replay the request. We indicate this using
283 * -EAGAIN.
284 */
285 if (tp_ops != NULL) {
286 module_put(tp_ops->owner);
287 err = -EAGAIN;
288 }
289 }
290#endif
291 kfree(tp);
292 goto errout;
293 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700294 tp->ops = tp_ops;
295 tp->protocol = protocol;
John Fastabend25d8c0d2014-09-12 20:05:27 -0700296 tp->prio = nprio ? :
297 TC_H_MAJ(tcf_auto_prio(rtnl_dereference(*back)));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700298 tp->q = q;
299 tp->classify = tp_ops->classify;
300 tp->classid = parent;
Stephen Hemmingeraa767bf2008-01-21 02:26:41 -0800301
302 err = tp_ops->init(tp);
303 if (err != 0) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700304 module_put(tp_ops->owner);
305 kfree(tp);
306 goto errout;
307 }
308
Minoru Usui12186be2009-06-02 02:17:34 -0700309 tp_created = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700310
Patrick McHardyadd93b62008-01-22 22:11:33 -0800311 } else if (tca[TCA_KIND] && nla_strcmp(tca[TCA_KIND], tp->ops->kind))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700312 goto errout;
313
314 fh = tp->ops->get(tp, t->tcm_handle);
315
316 if (fh == 0) {
317 if (n->nlmsg_type == RTM_DELTFILTER && t->tcm_handle == 0) {
John Fastabend25d8c0d2014-09-12 20:05:27 -0700318 struct tcf_proto *next = rtnl_dereference(tp->next);
319
320 RCU_INIT_POINTER(*back, next);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700321
Tom Goff7316ae82010-03-19 15:40:13 +0000322 tfilter_notify(net, skb, n, tp, fh, RTM_DELTFILTER);
Cong Wang1e052be2015-03-06 11:47:59 -0800323 tcf_destroy(tp, true);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700324 err = 0;
325 goto errout;
326 }
327
328 err = -ENOENT;
Stephen Hemmingeraa767bf2008-01-21 02:26:41 -0800329 if (n->nlmsg_type != RTM_NEWTFILTER ||
330 !(n->nlmsg_flags & NLM_F_CREATE))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700331 goto errout;
332 } else {
333 switch (n->nlmsg_type) {
YOSHIFUJI Hideaki10297b92007-02-09 23:25:16 +0900334 case RTM_NEWTFILTER:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700335 err = -EEXIST;
Minoru Usui12186be2009-06-02 02:17:34 -0700336 if (n->nlmsg_flags & NLM_F_EXCL) {
337 if (tp_created)
Cong Wang1e052be2015-03-06 11:47:59 -0800338 tcf_destroy(tp, true);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700339 goto errout;
Minoru Usui12186be2009-06-02 02:17:34 -0700340 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700341 break;
342 case RTM_DELTFILTER:
343 err = tp->ops->delete(tp, fh);
Cong Wang1e052be2015-03-06 11:47:59 -0800344 if (err == 0) {
WANG Congd7443182015-05-05 15:22:02 -0700345 struct tcf_proto *next = rtnl_dereference(tp->next);
Cong Wang1e052be2015-03-06 11:47:59 -0800346
WANG Congd7443182015-05-05 15:22:02 -0700347 tfilter_notify(net, skb, n, tp, fh, RTM_DELTFILTER);
348 if (tcf_destroy(tp, false))
Cong Wang1e052be2015-03-06 11:47:59 -0800349 RCU_INIT_POINTER(*back, next);
Cong Wang1e052be2015-03-06 11:47:59 -0800350 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700351 goto errout;
352 case RTM_GETTFILTER:
Tom Goff7316ae82010-03-19 15:40:13 +0000353 err = tfilter_notify(net, skb, n, tp, fh, RTM_NEWTFILTER);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700354 goto errout;
355 default:
356 err = -EINVAL;
357 goto errout;
358 }
359 }
360
Cong Wang2f7ef2f2014-04-25 13:54:06 -0700361 err = tp->ops->change(net, skb, tp, cl, t->tcm_handle, tca, &fh,
362 n->nlmsg_flags & NLM_F_CREATE ? TCA_ACT_NOREPLACE : TCA_ACT_REPLACE);
Minoru Usui12186be2009-06-02 02:17:34 -0700363 if (err == 0) {
364 if (tp_created) {
John Fastabend25d8c0d2014-09-12 20:05:27 -0700365 RCU_INIT_POINTER(tp->next, rtnl_dereference(*back));
366 rcu_assign_pointer(*back, tp);
Minoru Usui12186be2009-06-02 02:17:34 -0700367 }
Tom Goff7316ae82010-03-19 15:40:13 +0000368 tfilter_notify(net, skb, n, tp, fh, RTM_NEWTFILTER);
Minoru Usui12186be2009-06-02 02:17:34 -0700369 } else {
370 if (tp_created)
Cong Wang1e052be2015-03-06 11:47:59 -0800371 tcf_destroy(tp, true);
Minoru Usui12186be2009-06-02 02:17:34 -0700372 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700373
374errout:
375 if (cl)
376 cops->put(q, cl);
377 if (err == -EAGAIN)
378 /* Replay the request. */
379 goto replay;
380 return err;
381}
382
Jamal Hadi Salim0b0f43f2016-06-05 10:41:32 -0400383static int tcf_fill_node(struct net *net, struct sk_buff *skb,
384 struct tcf_proto *tp, unsigned long fh, u32 portid,
385 u32 seq, u16 flags, int event)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700386{
387 struct tcmsg *tcm;
388 struct nlmsghdr *nlh;
Arnaldo Carvalho de Melo27a884d2007-04-19 20:29:13 -0700389 unsigned char *b = skb_tail_pointer(skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700390
Eric W. Biederman15e47302012-09-07 20:12:54 +0000391 nlh = nlmsg_put(skb, portid, seq, event, sizeof(*tcm), flags);
David S. Miller942b8162012-06-26 21:48:50 -0700392 if (!nlh)
393 goto out_nlmsg_trim;
394 tcm = nlmsg_data(nlh);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700395 tcm->tcm_family = AF_UNSPEC;
Patrick McHardy9ef1d4c2005-06-28 12:55:30 -0700396 tcm->tcm__pad1 = 0;
Jiri Pirkoad61df92009-10-08 01:21:46 -0700397 tcm->tcm__pad2 = 0;
David S. Miller5ce2d482008-07-08 17:06:30 -0700398 tcm->tcm_ifindex = qdisc_dev(tp->q)->ifindex;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700399 tcm->tcm_parent = tp->classid;
400 tcm->tcm_info = TC_H_MAKE(tp->prio, tp->protocol);
David S. Miller1b34ec42012-03-29 05:11:39 -0400401 if (nla_put_string(skb, TCA_KIND, tp->ops->kind))
402 goto nla_put_failure;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700403 tcm->tcm_handle = fh;
404 if (RTM_DELTFILTER != event) {
405 tcm->tcm_handle = 0;
WANG Cong832d1d52014-01-09 16:14:01 -0800406 if (tp->ops->dump && tp->ops->dump(net, tp, fh, skb, tcm) < 0)
Patrick McHardyadd93b62008-01-22 22:11:33 -0800407 goto nla_put_failure;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700408 }
Arnaldo Carvalho de Melo27a884d2007-04-19 20:29:13 -0700409 nlh->nlmsg_len = skb_tail_pointer(skb) - b;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700410 return skb->len;
411
David S. Miller942b8162012-06-26 21:48:50 -0700412out_nlmsg_trim:
Patrick McHardyadd93b62008-01-22 22:11:33 -0800413nla_put_failure:
Arnaldo Carvalho de Melodc5fc572007-03-25 23:06:12 -0700414 nlmsg_trim(skb, b);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700415 return -1;
416}
417
Tom Goff7316ae82010-03-19 15:40:13 +0000418static int tfilter_notify(struct net *net, struct sk_buff *oskb,
419 struct nlmsghdr *n, struct tcf_proto *tp,
420 unsigned long fh, int event)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700421{
422 struct sk_buff *skb;
Eric W. Biederman15e47302012-09-07 20:12:54 +0000423 u32 portid = oskb ? NETLINK_CB(oskb).portid : 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700424
425 skb = alloc_skb(NLMSG_GOODSIZE, GFP_KERNEL);
426 if (!skb)
427 return -ENOBUFS;
428
WANG Cong832d1d52014-01-09 16:14:01 -0800429 if (tcf_fill_node(net, skb, tp, fh, portid, n->nlmsg_seq, 0, event) <= 0) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700430 kfree_skb(skb);
431 return -EINVAL;
432 }
433
Eric W. Biederman15e47302012-09-07 20:12:54 +0000434 return rtnetlink_send(skb, net, portid, RTNLGRP_TC,
Stephen Hemmingeraa767bf2008-01-21 02:26:41 -0800435 n->nlmsg_flags & NLM_F_ECHO);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700436}
437
Stephen Hemmingeraa767bf2008-01-21 02:26:41 -0800438struct tcf_dump_args {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700439 struct tcf_walker w;
440 struct sk_buff *skb;
441 struct netlink_callback *cb;
442};
443
Stephen Hemmingeraa767bf2008-01-21 02:26:41 -0800444static int tcf_node_dump(struct tcf_proto *tp, unsigned long n,
445 struct tcf_walker *arg)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700446{
Stephen Hemmingeraa767bf2008-01-21 02:26:41 -0800447 struct tcf_dump_args *a = (void *)arg;
WANG Cong832d1d52014-01-09 16:14:01 -0800448 struct net *net = sock_net(a->skb->sk);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700449
WANG Cong832d1d52014-01-09 16:14:01 -0800450 return tcf_fill_node(net, a->skb, tp, n, NETLINK_CB(a->cb->skb).portid,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700451 a->cb->nlh->nlmsg_seq, NLM_F_MULTI, RTM_NEWTFILTER);
452}
453
Eric Dumazetbd27a872009-11-05 20:57:26 -0800454/* called with RTNL */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700455static int tc_dump_tfilter(struct sk_buff *skb, struct netlink_callback *cb)
456{
YOSHIFUJI Hideaki3b1e0a62008-03-26 02:26:21 +0900457 struct net *net = sock_net(skb->sk);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700458 int t;
459 int s_t;
460 struct net_device *dev;
461 struct Qdisc *q;
John Fastabend25d8c0d2014-09-12 20:05:27 -0700462 struct tcf_proto *tp, __rcu **chain;
David S. Miller942b8162012-06-26 21:48:50 -0700463 struct tcmsg *tcm = nlmsg_data(cb->nlh);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700464 unsigned long cl = 0;
Eric Dumazet20fea082007-11-14 01:44:41 -0800465 const struct Qdisc_class_ops *cops;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700466 struct tcf_dump_args arg;
467
Hong zhi guo573ce262013-03-27 06:47:04 +0000468 if (nlmsg_len(cb->nlh) < sizeof(*tcm))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700469 return skb->len;
Eric Dumazetcc7ec452011-01-19 19:26:56 +0000470 dev = __dev_get_by_index(net, tcm->tcm_ifindex);
471 if (!dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700472 return skb->len;
473
Linus Torvalds1da177e2005-04-16 15:20:36 -0700474 if (!tcm->tcm_parent)
Patrick McHardyaf356af2009-09-04 06:41:18 +0000475 q = dev->qdisc;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700476 else
477 q = qdisc_lookup(dev, TC_H_MAJ(tcm->tcm_parent));
478 if (!q)
479 goto out;
Eric Dumazetcc7ec452011-01-19 19:26:56 +0000480 cops = q->ops->cl_ops;
481 if (!cops)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700482 goto errout;
Patrick McHardy71ebe5e2009-09-04 06:41:15 +0000483 if (cops->tcf_chain == NULL)
484 goto errout;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700485 if (TC_H_MIN(tcm->tcm_parent)) {
486 cl = cops->get(q, tcm->tcm_parent);
487 if (cl == 0)
488 goto errout;
489 }
490 chain = cops->tcf_chain(q, cl);
491 if (chain == NULL)
492 goto errout;
493
494 s_t = cb->args[0];
495
John Fastabend25d8c0d2014-09-12 20:05:27 -0700496 for (tp = rtnl_dereference(*chain), t = 0;
497 tp; tp = rtnl_dereference(tp->next), t++) {
Eric Dumazetcc7ec452011-01-19 19:26:56 +0000498 if (t < s_t)
499 continue;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700500 if (TC_H_MAJ(tcm->tcm_info) &&
501 TC_H_MAJ(tcm->tcm_info) != tp->prio)
502 continue;
503 if (TC_H_MIN(tcm->tcm_info) &&
504 TC_H_MIN(tcm->tcm_info) != tp->protocol)
505 continue;
506 if (t > s_t)
Jamal Hadi Salim0b0f43f2016-06-05 10:41:32 -0400507 memset(&cb->args[1], 0,
508 sizeof(cb->args)-sizeof(cb->args[0]));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700509 if (cb->args[1] == 0) {
Jamal Hadi Salim0b0f43f2016-06-05 10:41:32 -0400510 if (tcf_fill_node(net, skb, tp, 0,
511 NETLINK_CB(cb->skb).portid,
Stephen Hemmingeraa767bf2008-01-21 02:26:41 -0800512 cb->nlh->nlmsg_seq, NLM_F_MULTI,
513 RTM_NEWTFILTER) <= 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700514 break;
Stephen Hemmingeraa767bf2008-01-21 02:26:41 -0800515
Linus Torvalds1da177e2005-04-16 15:20:36 -0700516 cb->args[1] = 1;
517 }
518 if (tp->ops->walk == NULL)
519 continue;
520 arg.w.fn = tcf_node_dump;
521 arg.skb = skb;
522 arg.cb = cb;
523 arg.w.stop = 0;
Eric Dumazetcc7ec452011-01-19 19:26:56 +0000524 arg.w.skip = cb->args[1] - 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700525 arg.w.count = 0;
526 tp->ops->walk(tp, &arg.w);
Eric Dumazetcc7ec452011-01-19 19:26:56 +0000527 cb->args[1] = arg.w.count + 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700528 if (arg.w.stop)
529 break;
530 }
531
532 cb->args[0] = t;
533
534errout:
535 if (cl)
536 cops->put(q, cl);
537out:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700538 return skb->len;
539}
540
WANG Cong18d02642014-09-25 10:26:37 -0700541void tcf_exts_destroy(struct tcf_exts *exts)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700542{
543#ifdef CONFIG_NET_CLS_ACT
WANG Cong22dc13c2016-08-13 22:35:00 -0700544 LIST_HEAD(actions);
545
546 tcf_exts_to_list(exts, &actions);
547 tcf_action_destroy(&actions, TCA_ACT_UNBIND);
548 kfree(exts->actions);
549 exts->nr_actions = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700550#endif
551}
Stephen Hemmingeraa767bf2008-01-21 02:26:41 -0800552EXPORT_SYMBOL(tcf_exts_destroy);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700553
Benjamin LaHaisec1b52732013-01-14 05:15:39 +0000554int tcf_exts_validate(struct net *net, struct tcf_proto *tp, struct nlattr **tb,
Cong Wang2f7ef2f2014-04-25 13:54:06 -0700555 struct nlattr *rate_tlv, struct tcf_exts *exts, bool ovr)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700556{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700557#ifdef CONFIG_NET_CLS_ACT
558 {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700559 struct tc_action *act;
560
WANG Cong5da57f42013-12-15 20:15:07 -0800561 if (exts->police && tb[exts->police]) {
562 act = tcf_action_init_1(net, tb[exts->police], rate_tlv,
Cong Wang2f7ef2f2014-04-25 13:54:06 -0700563 "police", ovr,
Patrick McHardyab27cfb2008-01-23 20:33:13 -0800564 TCA_ACT_BIND);
565 if (IS_ERR(act))
566 return PTR_ERR(act);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700567
WANG Cong33be6272013-12-15 20:15:05 -0800568 act->type = exts->type = TCA_OLD_COMPAT;
WANG Cong22dc13c2016-08-13 22:35:00 -0700569 exts->actions[0] = act;
570 exts->nr_actions = 1;
WANG Cong5da57f42013-12-15 20:15:07 -0800571 } else if (exts->action && tb[exts->action]) {
WANG Cong22dc13c2016-08-13 22:35:00 -0700572 LIST_HEAD(actions);
573 int err, i = 0;
574
WANG Cong5da57f42013-12-15 20:15:07 -0800575 err = tcf_action_init(net, tb[exts->action], rate_tlv,
Cong Wang2f7ef2f2014-04-25 13:54:06 -0700576 NULL, ovr,
WANG Cong22dc13c2016-08-13 22:35:00 -0700577 TCA_ACT_BIND, &actions);
WANG Cong33be6272013-12-15 20:15:05 -0800578 if (err)
579 return err;
WANG Cong22dc13c2016-08-13 22:35:00 -0700580 list_for_each_entry(act, &actions, list)
581 exts->actions[i++] = act;
582 exts->nr_actions = i;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700583 }
584 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700585#else
WANG Cong5da57f42013-12-15 20:15:07 -0800586 if ((exts->action && tb[exts->action]) ||
587 (exts->police && tb[exts->police]))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700588 return -EOPNOTSUPP;
589#endif
590
591 return 0;
592}
Stephen Hemmingeraa767bf2008-01-21 02:26:41 -0800593EXPORT_SYMBOL(tcf_exts_validate);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700594
Stephen Hemmingeraa767bf2008-01-21 02:26:41 -0800595void tcf_exts_change(struct tcf_proto *tp, struct tcf_exts *dst,
596 struct tcf_exts *src)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700597{
598#ifdef CONFIG_NET_CLS_ACT
WANG Cong22dc13c2016-08-13 22:35:00 -0700599 struct tcf_exts old = *dst;
600
Cong Wanga49eb422014-04-25 13:55:30 -0700601 tcf_tree_lock(tp);
WANG Cong22dc13c2016-08-13 22:35:00 -0700602 dst->nr_actions = src->nr_actions;
603 dst->actions = src->actions;
WANG Cong5301e3e2014-10-06 17:21:54 -0700604 dst->type = src->type;
Cong Wanga49eb422014-04-25 13:55:30 -0700605 tcf_tree_unlock(tp);
WANG Cong22dc13c2016-08-13 22:35:00 -0700606
607 tcf_exts_destroy(&old);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700608#endif
609}
Stephen Hemmingeraa767bf2008-01-21 02:26:41 -0800610EXPORT_SYMBOL(tcf_exts_change);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700611
WANG Cong22dc13c2016-08-13 22:35:00 -0700612#ifdef CONFIG_NET_CLS_ACT
613static struct tc_action *tcf_exts_first_act(struct tcf_exts *exts)
614{
615 if (exts->nr_actions == 0)
616 return NULL;
617 else
618 return exts->actions[0];
619}
620#endif
WANG Cong33be6272013-12-15 20:15:05 -0800621
WANG Cong5da57f42013-12-15 20:15:07 -0800622int tcf_exts_dump(struct sk_buff *skb, struct tcf_exts *exts)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700623{
624#ifdef CONFIG_NET_CLS_ACT
Cong Wang9cc63db2014-07-16 14:25:30 -0700625 struct nlattr *nest;
626
WANG Cong22dc13c2016-08-13 22:35:00 -0700627 if (exts->action && exts->nr_actions) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700628 /*
629 * again for backward compatible mode - we want
630 * to work with both old and new modes of entering
631 * tc data even if iproute2 was newer - jhs
632 */
WANG Cong33be6272013-12-15 20:15:05 -0800633 if (exts->type != TCA_OLD_COMPAT) {
WANG Cong22dc13c2016-08-13 22:35:00 -0700634 LIST_HEAD(actions);
635
WANG Cong5da57f42013-12-15 20:15:07 -0800636 nest = nla_nest_start(skb, exts->action);
Patrick McHardy4b3550ef2008-01-23 20:34:11 -0800637 if (nest == NULL)
638 goto nla_put_failure;
WANG Cong22dc13c2016-08-13 22:35:00 -0700639
640 tcf_exts_to_list(exts, &actions);
641 if (tcf_action_dump(skb, &actions, 0, 0) < 0)
Patrick McHardyadd93b62008-01-22 22:11:33 -0800642 goto nla_put_failure;
Patrick McHardy4b3550ef2008-01-23 20:34:11 -0800643 nla_nest_end(skb, nest);
WANG Cong5da57f42013-12-15 20:15:07 -0800644 } else if (exts->police) {
WANG Cong33be6272013-12-15 20:15:05 -0800645 struct tc_action *act = tcf_exts_first_act(exts);
WANG Cong5da57f42013-12-15 20:15:07 -0800646 nest = nla_nest_start(skb, exts->police);
Jamal Hadi Salim63acd682013-12-23 08:02:12 -0500647 if (nest == NULL || !act)
Patrick McHardy4b3550ef2008-01-23 20:34:11 -0800648 goto nla_put_failure;
WANG Cong33be6272013-12-15 20:15:05 -0800649 if (tcf_action_dump_old(skb, act, 0, 0) < 0)
Patrick McHardyadd93b62008-01-22 22:11:33 -0800650 goto nla_put_failure;
Patrick McHardy4b3550ef2008-01-23 20:34:11 -0800651 nla_nest_end(skb, nest);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700652 }
653 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700654 return 0;
Cong Wang9cc63db2014-07-16 14:25:30 -0700655
656nla_put_failure:
657 nla_nest_cancel(skb, nest);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700658 return -1;
Cong Wang9cc63db2014-07-16 14:25:30 -0700659#else
660 return 0;
661#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -0700662}
Stephen Hemmingeraa767bf2008-01-21 02:26:41 -0800663EXPORT_SYMBOL(tcf_exts_dump);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700664
Stephen Hemmingeraa767bf2008-01-21 02:26:41 -0800665
WANG Cong5da57f42013-12-15 20:15:07 -0800666int tcf_exts_dump_stats(struct sk_buff *skb, struct tcf_exts *exts)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700667{
668#ifdef CONFIG_NET_CLS_ACT
WANG Cong33be6272013-12-15 20:15:05 -0800669 struct tc_action *a = tcf_exts_first_act(exts);
Ignacy Gawędzkib057df22015-02-03 19:05:18 +0100670 if (a != NULL && tcf_action_copy_stats(skb, a, 1) < 0)
WANG Cong33be6272013-12-15 20:15:05 -0800671 return -1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700672#endif
673 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700674}
Stephen Hemmingeraa767bf2008-01-21 02:26:41 -0800675EXPORT_SYMBOL(tcf_exts_dump_stats);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700676
677static int __init tc_filter_init(void)
678{
Greg Rosec7ac8672011-06-10 01:27:09 +0000679 rtnl_register(PF_UNSPEC, RTM_NEWTFILTER, tc_ctl_tfilter, NULL, NULL);
680 rtnl_register(PF_UNSPEC, RTM_DELTFILTER, tc_ctl_tfilter, NULL, NULL);
Thomas Graf82623c02007-03-22 11:56:22 -0700681 rtnl_register(PF_UNSPEC, RTM_GETTFILTER, tc_ctl_tfilter,
Greg Rosec7ac8672011-06-10 01:27:09 +0000682 tc_dump_tfilter, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700683
Linus Torvalds1da177e2005-04-16 15:20:36 -0700684 return 0;
685}
686
687subsys_initcall(tc_filter_init);