blob: f427a1e00e7ee91ae401f9b7b78ced964e18914c [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>
Jiri Pirko33a48922017-02-09 14:38:57 +010022#include <linux/err.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070023#include <linux/skbuff.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070024#include <linux/init.h>
25#include <linux/kmod.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090026#include <linux/slab.h>
Jiri Pirko48617382018-01-17 11:46:46 +010027#include <linux/idr.h>
Denis V. Lunevb8542722007-12-01 00:21:31 +110028#include <net/net_namespace.h>
29#include <net/sock.h>
Arnaldo Carvalho de Melodc5fc572007-03-25 23:06:12 -070030#include <net/netlink.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070031#include <net/pkt_sched.h>
32#include <net/pkt_cls.h>
33
Davide Carattie3314732018-10-10 22:00:58 +020034extern const struct nla_policy rtm_tca_policy[TCA_MAX + 1];
35
Linus Torvalds1da177e2005-04-16 15:20:36 -070036/* The list of all installed classifier types */
WANG Cong36272872013-12-15 20:15:11 -080037static LIST_HEAD(tcf_proto_base);
Linus Torvalds1da177e2005-04-16 15:20:36 -070038
39/* Protects list of registered TC modules. It is pure SMP lock. */
40static DEFINE_RWLOCK(cls_mod_lock);
41
42/* Find classifier type by string name */
43
Jiri Pirkof34e8bf2018-07-23 09:23:04 +020044static const struct tcf_proto_ops *__tcf_proto_lookup_ops(const char *kind)
Linus Torvalds1da177e2005-04-16 15:20:36 -070045{
Eric Dumazetdcd76082013-12-20 10:04:18 -080046 const struct tcf_proto_ops *t, *res = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -070047
48 if (kind) {
49 read_lock(&cls_mod_lock);
WANG Cong36272872013-12-15 20:15:11 -080050 list_for_each_entry(t, &tcf_proto_base, head) {
Jiri Pirko33a48922017-02-09 14:38:57 +010051 if (strcmp(kind, t->kind) == 0) {
Eric Dumazetdcd76082013-12-20 10:04:18 -080052 if (try_module_get(t->owner))
53 res = t;
Linus Torvalds1da177e2005-04-16 15:20:36 -070054 break;
55 }
56 }
57 read_unlock(&cls_mod_lock);
58 }
Eric Dumazetdcd76082013-12-20 10:04:18 -080059 return res;
Linus Torvalds1da177e2005-04-16 15:20:36 -070060}
61
Jiri Pirkof34e8bf2018-07-23 09:23:04 +020062static const struct tcf_proto_ops *
63tcf_proto_lookup_ops(const char *kind, struct netlink_ext_ack *extack)
64{
65 const struct tcf_proto_ops *ops;
66
67 ops = __tcf_proto_lookup_ops(kind);
68 if (ops)
69 return ops;
70#ifdef CONFIG_MODULES
71 rtnl_unlock();
72 request_module("cls_%s", kind);
73 rtnl_lock();
74 ops = __tcf_proto_lookup_ops(kind);
75 /* We dropped the RTNL semaphore in order to perform
76 * the module load. So, even if we succeeded in loading
77 * the module we have to replay the request. We indicate
78 * this using -EAGAIN.
79 */
80 if (ops) {
81 module_put(ops->owner);
82 return ERR_PTR(-EAGAIN);
83 }
84#endif
85 NL_SET_ERR_MSG(extack, "TC classifier not found");
86 return ERR_PTR(-ENOENT);
87}
88
Linus Torvalds1da177e2005-04-16 15:20:36 -070089/* Register(unregister) new classifier type */
90
91int register_tcf_proto_ops(struct tcf_proto_ops *ops)
92{
WANG Cong36272872013-12-15 20:15:11 -080093 struct tcf_proto_ops *t;
Linus Torvalds1da177e2005-04-16 15:20:36 -070094 int rc = -EEXIST;
95
96 write_lock(&cls_mod_lock);
WANG Cong36272872013-12-15 20:15:11 -080097 list_for_each_entry(t, &tcf_proto_base, head)
Linus Torvalds1da177e2005-04-16 15:20:36 -070098 if (!strcmp(ops->kind, t->kind))
99 goto out;
100
WANG Cong36272872013-12-15 20:15:11 -0800101 list_add_tail(&ops->head, &tcf_proto_base);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700102 rc = 0;
103out:
104 write_unlock(&cls_mod_lock);
105 return rc;
106}
Stephen Hemmingeraa767bf2008-01-21 02:26:41 -0800107EXPORT_SYMBOL(register_tcf_proto_ops);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700108
Cong Wang7aa00452017-10-26 18:24:28 -0700109static struct workqueue_struct *tc_filter_wq;
110
Linus Torvalds1da177e2005-04-16 15:20:36 -0700111int unregister_tcf_proto_ops(struct tcf_proto_ops *ops)
112{
WANG Cong36272872013-12-15 20:15:11 -0800113 struct tcf_proto_ops *t;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700114 int rc = -ENOENT;
115
Daniel Borkmannc78e1742015-05-20 17:13:33 +0200116 /* Wait for outstanding call_rcu()s, if any, from a
117 * tcf_proto_ops's destroy() handler.
118 */
119 rcu_barrier();
Cong Wang7aa00452017-10-26 18:24:28 -0700120 flush_workqueue(tc_filter_wq);
Daniel Borkmannc78e1742015-05-20 17:13:33 +0200121
Linus Torvalds1da177e2005-04-16 15:20:36 -0700122 write_lock(&cls_mod_lock);
Eric Dumazetdcd76082013-12-20 10:04:18 -0800123 list_for_each_entry(t, &tcf_proto_base, head) {
124 if (t == ops) {
125 list_del(&t->head);
126 rc = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700127 break;
Eric Dumazetdcd76082013-12-20 10:04:18 -0800128 }
129 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700130 write_unlock(&cls_mod_lock);
131 return rc;
132}
Stephen Hemmingeraa767bf2008-01-21 02:26:41 -0800133EXPORT_SYMBOL(unregister_tcf_proto_ops);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700134
Cong Wangaaa908f2018-05-23 15:26:53 -0700135bool tcf_queue_work(struct rcu_work *rwork, work_func_t func)
Cong Wang7aa00452017-10-26 18:24:28 -0700136{
Cong Wangaaa908f2018-05-23 15:26:53 -0700137 INIT_RCU_WORK(rwork, func);
138 return queue_rcu_work(tc_filter_wq, rwork);
Cong Wang7aa00452017-10-26 18:24:28 -0700139}
140EXPORT_SYMBOL(tcf_queue_work);
141
Linus Torvalds1da177e2005-04-16 15:20:36 -0700142/* Select new prio value from the range, managed by kernel. */
143
Stephen Hemmingeraa767bf2008-01-21 02:26:41 -0800144static inline u32 tcf_auto_prio(struct tcf_proto *tp)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700145{
Stephen Hemmingeraa767bf2008-01-21 02:26:41 -0800146 u32 first = TC_H_MAKE(0xC0000000U, 0U);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700147
148 if (tp)
Eric Dumazetcc7ec452011-01-19 19:26:56 +0000149 first = tp->prio - 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700150
Jiri Pirko79619732017-05-17 11:07:58 +0200151 return TC_H_MAJ(first);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700152}
153
Jiri Pirko33a48922017-02-09 14:38:57 +0100154static struct tcf_proto *tcf_proto_create(const char *kind, u32 protocol,
Alexander Aringc35a4ac2018-01-18 11:20:50 -0500155 u32 prio, struct tcf_chain *chain,
156 struct netlink_ext_ack *extack)
Jiri Pirko33a48922017-02-09 14:38:57 +0100157{
158 struct tcf_proto *tp;
159 int err;
160
161 tp = kzalloc(sizeof(*tp), GFP_KERNEL);
162 if (!tp)
163 return ERR_PTR(-ENOBUFS);
164
Jiri Pirkof34e8bf2018-07-23 09:23:04 +0200165 tp->ops = tcf_proto_lookup_ops(kind, extack);
166 if (IS_ERR(tp->ops)) {
167 err = PTR_ERR(tp->ops);
Jiri Pirkod68d75f2018-05-11 17:45:32 +0200168 goto errout;
Jiri Pirko33a48922017-02-09 14:38:57 +0100169 }
170 tp->classify = tp->ops->classify;
171 tp->protocol = protocol;
172 tp->prio = prio;
Jiri Pirko5bc17012017-05-17 11:08:01 +0200173 tp->chain = chain;
Jiri Pirko33a48922017-02-09 14:38:57 +0100174
175 err = tp->ops->init(tp);
176 if (err) {
177 module_put(tp->ops->owner);
178 goto errout;
179 }
180 return tp;
181
182errout:
183 kfree(tp);
184 return ERR_PTR(err);
185}
186
Jakub Kicinski715df5e2018-01-24 12:54:13 -0800187static void tcf_proto_destroy(struct tcf_proto *tp,
188 struct netlink_ext_ack *extack)
Jiri Pirkocf1facd2017-02-09 14:38:56 +0100189{
Jakub Kicinski715df5e2018-01-24 12:54:13 -0800190 tp->ops->destroy(tp, extack);
WANG Cong763dbf62017-04-19 14:21:21 -0700191 module_put(tp->ops->owner);
192 kfree_rcu(tp, rcu);
Jiri Pirkocf1facd2017-02-09 14:38:56 +0100193}
194
Jiri Pirkoa9b19442018-01-17 11:46:45 +0100195struct tcf_filter_chain_list_item {
196 struct list_head list;
197 tcf_chain_head_change_t *chain_head_change;
198 void *chain_head_change_priv;
199};
200
Jiri Pirko5bc17012017-05-17 11:08:01 +0200201static struct tcf_chain *tcf_chain_create(struct tcf_block *block,
202 u32 chain_index)
Jiri Pirko2190d1d2017-05-17 11:07:59 +0200203{
Jiri Pirko5bc17012017-05-17 11:08:01 +0200204 struct tcf_chain *chain;
205
206 chain = kzalloc(sizeof(*chain), GFP_KERNEL);
207 if (!chain)
208 return NULL;
209 list_add_tail(&chain->list, &block->chain_list);
210 chain->block = block;
211 chain->index = chain_index;
Cong Wange2ef7542017-09-11 16:33:31 -0700212 chain->refcnt = 1;
Jiri Pirkof71e0ca42018-07-23 09:23:05 +0200213 if (!chain->index)
214 block->chain0.chain = chain;
Jiri Pirko5bc17012017-05-17 11:08:01 +0200215 return chain;
Jiri Pirko2190d1d2017-05-17 11:07:59 +0200216}
217
Jiri Pirkoa9b19442018-01-17 11:46:45 +0100218static void tcf_chain_head_change_item(struct tcf_filter_chain_list_item *item,
219 struct tcf_proto *tp_head)
220{
221 if (item->chain_head_change)
222 item->chain_head_change(tp_head, item->chain_head_change_priv);
223}
Jiri Pirkof71e0ca42018-07-23 09:23:05 +0200224
225static void tcf_chain0_head_change(struct tcf_chain *chain,
226 struct tcf_proto *tp_head)
Jiri Pirkoc7eb7d72017-11-03 11:46:24 +0100227{
Jiri Pirkoa9b19442018-01-17 11:46:45 +0100228 struct tcf_filter_chain_list_item *item;
Jiri Pirkof71e0ca42018-07-23 09:23:05 +0200229 struct tcf_block *block = chain->block;
Jiri Pirkoa9b19442018-01-17 11:46:45 +0100230
Jiri Pirkof71e0ca42018-07-23 09:23:05 +0200231 if (chain->index)
232 return;
233 list_for_each_entry(item, &block->chain0.filter_chain_list, list)
Jiri Pirkoa9b19442018-01-17 11:46:45 +0100234 tcf_chain_head_change_item(item, tp_head);
Jiri Pirkoc7eb7d72017-11-03 11:46:24 +0100235}
236
Jiri Pirkof93e1cd2017-05-20 15:01:32 +0200237static void tcf_chain_destroy(struct tcf_chain *chain)
238{
Cong Wangefbf7892017-12-04 10:48:18 -0800239 struct tcf_block *block = chain->block;
240
Cong Wange2ef7542017-09-11 16:33:31 -0700241 list_del(&chain->list);
Jiri Pirkof71e0ca42018-07-23 09:23:05 +0200242 if (!chain->index)
243 block->chain0.chain = NULL;
Cong Wange2ef7542017-09-11 16:33:31 -0700244 kfree(chain);
Vlad Buslovcfebd7e2018-09-24 19:22:54 +0300245 if (list_empty(&block->chain_list) && !refcount_read(&block->refcnt))
Vlad Buslov0607e432018-09-24 19:22:57 +0300246 kfree_rcu(block, rcu);
Cong Wange2ef7542017-09-11 16:33:31 -0700247}
Jiri Pirko744a4cf2017-08-22 22:46:49 +0200248
Cong Wange2ef7542017-09-11 16:33:31 -0700249static void tcf_chain_hold(struct tcf_chain *chain)
250{
251 ++chain->refcnt;
Jiri Pirko2190d1d2017-05-17 11:07:59 +0200252}
253
Jiri Pirko3d32f4c2018-08-01 12:36:55 +0200254static bool tcf_chain_held_by_acts_only(struct tcf_chain *chain)
Jiri Pirko1f3ed382018-07-27 09:45:05 +0200255{
256 /* In case all the references are action references, this
Jiri Pirko3d32f4c2018-08-01 12:36:55 +0200257 * chain should not be shown to the user.
Jiri Pirko1f3ed382018-07-27 09:45:05 +0200258 */
259 return chain->refcnt == chain->action_refcnt;
260}
261
Jiri Pirko32a4f5e2018-07-23 09:23:06 +0200262static struct tcf_chain *tcf_chain_lookup(struct tcf_block *block,
263 u32 chain_index)
Jiri Pirko5bc17012017-05-17 11:08:01 +0200264{
265 struct tcf_chain *chain;
266
267 list_for_each_entry(chain, &block->chain_list, list) {
Jiri Pirko32a4f5e2018-07-23 09:23:06 +0200268 if (chain->index == chain_index)
Cong Wange2ef7542017-09-11 16:33:31 -0700269 return chain;
Jiri Pirko32a4f5e2018-07-23 09:23:06 +0200270 }
271 return NULL;
272}
273
274static int tc_chain_notify(struct tcf_chain *chain, struct sk_buff *oskb,
275 u32 seq, u16 flags, int event, bool unicast);
276
Jiri Pirko53681402018-08-01 12:36:56 +0200277static struct tcf_chain *__tcf_chain_get(struct tcf_block *block,
278 u32 chain_index, bool create,
279 bool by_act)
Jiri Pirko32a4f5e2018-07-23 09:23:06 +0200280{
281 struct tcf_chain *chain = tcf_chain_lookup(block, chain_index);
282
283 if (chain) {
284 tcf_chain_hold(chain);
Jiri Pirko53681402018-08-01 12:36:56 +0200285 } else {
286 if (!create)
287 return NULL;
288 chain = tcf_chain_create(block, chain_index);
289 if (!chain)
290 return NULL;
Jiri Pirko5bc17012017-05-17 11:08:01 +0200291 }
Jiri Pirko80532382017-09-06 13:14:19 +0200292
Jiri Pirko53681402018-08-01 12:36:56 +0200293 if (by_act)
294 ++chain->action_refcnt;
295
296 /* Send notification only in case we got the first
297 * non-action reference. Until then, the chain acts only as
298 * a placeholder for actions pointing to it and user ought
299 * not know about them.
300 */
301 if (chain->refcnt - chain->action_refcnt == 1 && !by_act)
302 tc_chain_notify(chain, NULL, 0, NLM_F_CREATE | NLM_F_EXCL,
303 RTM_NEWCHAIN, false);
304
Jiri Pirko32a4f5e2018-07-23 09:23:06 +0200305 return chain;
Jiri Pirko5bc17012017-05-17 11:08:01 +0200306}
Jiri Pirko53681402018-08-01 12:36:56 +0200307
Jiri Pirko290b1c82018-08-01 12:36:57 +0200308static struct tcf_chain *tcf_chain_get(struct tcf_block *block, u32 chain_index,
309 bool create)
Jiri Pirko53681402018-08-01 12:36:56 +0200310{
311 return __tcf_chain_get(block, chain_index, create, false);
312}
Jiri Pirko5bc17012017-05-17 11:08:01 +0200313
Jiri Pirko1f3ed382018-07-27 09:45:05 +0200314struct tcf_chain *tcf_chain_get_by_act(struct tcf_block *block, u32 chain_index)
315{
Jiri Pirko53681402018-08-01 12:36:56 +0200316 return __tcf_chain_get(block, chain_index, true, true);
Jiri Pirko1f3ed382018-07-27 09:45:05 +0200317}
318EXPORT_SYMBOL(tcf_chain_get_by_act);
319
Jiri Pirko9f407f12018-07-23 09:23:07 +0200320static void tc_chain_tmplt_del(struct tcf_chain *chain);
321
Jiri Pirko53681402018-08-01 12:36:56 +0200322static void __tcf_chain_put(struct tcf_chain *chain, bool by_act)
Jiri Pirko5bc17012017-05-17 11:08:01 +0200323{
Jiri Pirko53681402018-08-01 12:36:56 +0200324 if (by_act)
325 chain->action_refcnt--;
326 chain->refcnt--;
327
328 /* The last dropped non-action reference will trigger notification. */
329 if (chain->refcnt - chain->action_refcnt == 0 && !by_act)
Jiri Pirko32a4f5e2018-07-23 09:23:06 +0200330 tc_chain_notify(chain, NULL, 0, 0, RTM_DELCHAIN, false);
Jiri Pirko53681402018-08-01 12:36:56 +0200331
332 if (chain->refcnt == 0) {
Jiri Pirko9f407f12018-07-23 09:23:07 +0200333 tc_chain_tmplt_del(chain);
Jiri Pirko5bc17012017-05-17 11:08:01 +0200334 tcf_chain_destroy(chain);
Jiri Pirko32a4f5e2018-07-23 09:23:06 +0200335 }
Jiri Pirko5bc17012017-05-17 11:08:01 +0200336}
Jiri Pirko53681402018-08-01 12:36:56 +0200337
Jiri Pirko290b1c82018-08-01 12:36:57 +0200338static void tcf_chain_put(struct tcf_chain *chain)
Jiri Pirko53681402018-08-01 12:36:56 +0200339{
340 __tcf_chain_put(chain, false);
341}
Jiri Pirko5bc17012017-05-17 11:08:01 +0200342
Jiri Pirko1f3ed382018-07-27 09:45:05 +0200343void tcf_chain_put_by_act(struct tcf_chain *chain)
344{
Jiri Pirko53681402018-08-01 12:36:56 +0200345 __tcf_chain_put(chain, true);
Jiri Pirko1f3ed382018-07-27 09:45:05 +0200346}
347EXPORT_SYMBOL(tcf_chain_put_by_act);
348
Jiri Pirko32a4f5e2018-07-23 09:23:06 +0200349static void tcf_chain_put_explicitly_created(struct tcf_chain *chain)
350{
351 if (chain->explicitly_created)
352 tcf_chain_put(chain);
353}
354
Jiri Pirko290b1c82018-08-01 12:36:57 +0200355static void tcf_chain_flush(struct tcf_chain *chain)
356{
357 struct tcf_proto *tp = rtnl_dereference(chain->filter_chain);
358
359 tcf_chain0_head_change(chain, NULL);
360 while (tp) {
361 RCU_INIT_POINTER(chain->filter_chain, tp->next);
362 tcf_proto_destroy(tp, NULL);
363 tp = rtnl_dereference(chain->filter_chain);
364 tcf_chain_put(chain);
365 }
366}
367
Jiri Pirkocaa72602018-01-17 11:46:50 +0100368static bool tcf_block_offload_in_use(struct tcf_block *block)
Jiri Pirko8c4083b2017-10-19 15:50:29 +0200369{
Jiri Pirkocaa72602018-01-17 11:46:50 +0100370 return block->offloadcnt;
371}
372
373static int tcf_block_offload_cmd(struct tcf_block *block,
374 struct net_device *dev,
375 struct tcf_block_ext_info *ei,
John Hurley60513bd2018-06-25 14:30:04 -0700376 enum tc_block_command command,
377 struct netlink_ext_ack *extack)
Jiri Pirkocaa72602018-01-17 11:46:50 +0100378{
Jiri Pirko8c4083b2017-10-19 15:50:29 +0200379 struct tc_block_offload bo = {};
380
Jiri Pirko8c4083b2017-10-19 15:50:29 +0200381 bo.command = command;
382 bo.binder_type = ei->binder_type;
383 bo.block = block;
John Hurley60513bd2018-06-25 14:30:04 -0700384 bo.extack = extack;
Jiri Pirkocaa72602018-01-17 11:46:50 +0100385 return dev->netdev_ops->ndo_setup_tc(dev, TC_SETUP_BLOCK, &bo);
Jiri Pirko8c4083b2017-10-19 15:50:29 +0200386}
387
Jiri Pirkocaa72602018-01-17 11:46:50 +0100388static int tcf_block_offload_bind(struct tcf_block *block, struct Qdisc *q,
John Hurley60513bd2018-06-25 14:30:04 -0700389 struct tcf_block_ext_info *ei,
390 struct netlink_ext_ack *extack)
Jiri Pirko8c4083b2017-10-19 15:50:29 +0200391{
Jiri Pirkocaa72602018-01-17 11:46:50 +0100392 struct net_device *dev = q->dev_queue->dev;
393 int err;
394
395 if (!dev->netdev_ops->ndo_setup_tc)
396 goto no_offload_dev_inc;
397
398 /* If tc offload feature is disabled and the block we try to bind
399 * to already has some offloaded filters, forbid to bind.
400 */
John Hurley60513bd2018-06-25 14:30:04 -0700401 if (!tc_can_offload(dev) && tcf_block_offload_in_use(block)) {
402 NL_SET_ERR_MSG(extack, "Bind to offloaded block failed as dev has offload disabled");
Jiri Pirkocaa72602018-01-17 11:46:50 +0100403 return -EOPNOTSUPP;
John Hurley60513bd2018-06-25 14:30:04 -0700404 }
Jiri Pirkocaa72602018-01-17 11:46:50 +0100405
John Hurley60513bd2018-06-25 14:30:04 -0700406 err = tcf_block_offload_cmd(block, dev, ei, TC_BLOCK_BIND, extack);
Jiri Pirkocaa72602018-01-17 11:46:50 +0100407 if (err == -EOPNOTSUPP)
408 goto no_offload_dev_inc;
409 return err;
410
411no_offload_dev_inc:
412 if (tcf_block_offload_in_use(block))
413 return -EOPNOTSUPP;
414 block->nooffloaddevcnt++;
415 return 0;
Jiri Pirko8c4083b2017-10-19 15:50:29 +0200416}
417
418static void tcf_block_offload_unbind(struct tcf_block *block, struct Qdisc *q,
419 struct tcf_block_ext_info *ei)
420{
Jiri Pirkocaa72602018-01-17 11:46:50 +0100421 struct net_device *dev = q->dev_queue->dev;
422 int err;
423
424 if (!dev->netdev_ops->ndo_setup_tc)
425 goto no_offload_dev_dec;
John Hurley60513bd2018-06-25 14:30:04 -0700426 err = tcf_block_offload_cmd(block, dev, ei, TC_BLOCK_UNBIND, NULL);
Jiri Pirkocaa72602018-01-17 11:46:50 +0100427 if (err == -EOPNOTSUPP)
428 goto no_offload_dev_dec;
429 return;
430
431no_offload_dev_dec:
432 WARN_ON(block->nooffloaddevcnt-- == 0);
Jiri Pirko8c4083b2017-10-19 15:50:29 +0200433}
434
Jiri Pirkoa9b19442018-01-17 11:46:45 +0100435static int
Jiri Pirkof71e0ca42018-07-23 09:23:05 +0200436tcf_chain0_head_change_cb_add(struct tcf_block *block,
437 struct tcf_block_ext_info *ei,
438 struct netlink_ext_ack *extack)
Jiri Pirkoa9b19442018-01-17 11:46:45 +0100439{
Jiri Pirkof71e0ca42018-07-23 09:23:05 +0200440 struct tcf_chain *chain0 = block->chain0.chain;
Jiri Pirkoa9b19442018-01-17 11:46:45 +0100441 struct tcf_filter_chain_list_item *item;
442
443 item = kmalloc(sizeof(*item), GFP_KERNEL);
444 if (!item) {
445 NL_SET_ERR_MSG(extack, "Memory allocation for head change callback item failed");
446 return -ENOMEM;
447 }
448 item->chain_head_change = ei->chain_head_change;
449 item->chain_head_change_priv = ei->chain_head_change_priv;
Jiri Pirkof71e0ca42018-07-23 09:23:05 +0200450 if (chain0 && chain0->filter_chain)
451 tcf_chain_head_change_item(item, chain0->filter_chain);
452 list_add(&item->list, &block->chain0.filter_chain_list);
Jiri Pirkoa9b19442018-01-17 11:46:45 +0100453 return 0;
454}
455
456static void
Jiri Pirkof71e0ca42018-07-23 09:23:05 +0200457tcf_chain0_head_change_cb_del(struct tcf_block *block,
458 struct tcf_block_ext_info *ei)
Jiri Pirkoa9b19442018-01-17 11:46:45 +0100459{
Jiri Pirkof71e0ca42018-07-23 09:23:05 +0200460 struct tcf_chain *chain0 = block->chain0.chain;
Jiri Pirkoa9b19442018-01-17 11:46:45 +0100461 struct tcf_filter_chain_list_item *item;
462
Jiri Pirkof71e0ca42018-07-23 09:23:05 +0200463 list_for_each_entry(item, &block->chain0.filter_chain_list, list) {
Jiri Pirkoa9b19442018-01-17 11:46:45 +0100464 if ((!ei->chain_head_change && !ei->chain_head_change_priv) ||
465 (item->chain_head_change == ei->chain_head_change &&
466 item->chain_head_change_priv == ei->chain_head_change_priv)) {
Jiri Pirkof71e0ca42018-07-23 09:23:05 +0200467 if (chain0)
468 tcf_chain_head_change_item(item, NULL);
Jiri Pirkoa9b19442018-01-17 11:46:45 +0100469 list_del(&item->list);
470 kfree(item);
471 return;
472 }
473 }
474 WARN_ON(1);
475}
476
Jiri Pirko48617382018-01-17 11:46:46 +0100477struct tcf_net {
Vlad Buslovab281622018-09-24 19:22:56 +0300478 spinlock_t idr_lock; /* Protects idr */
Jiri Pirko48617382018-01-17 11:46:46 +0100479 struct idr idr;
480};
481
482static unsigned int tcf_net_id;
483
484static int tcf_block_insert(struct tcf_block *block, struct net *net,
Jiri Pirkobb047dd2018-02-13 12:00:16 +0100485 struct netlink_ext_ack *extack)
Jiri Pirkoa9b19442018-01-17 11:46:45 +0100486{
Jiri Pirko48617382018-01-17 11:46:46 +0100487 struct tcf_net *tn = net_generic(net, tcf_net_id);
Vlad Buslovab281622018-09-24 19:22:56 +0300488 int err;
Jiri Pirko48617382018-01-17 11:46:46 +0100489
Vlad Buslovab281622018-09-24 19:22:56 +0300490 idr_preload(GFP_KERNEL);
491 spin_lock(&tn->idr_lock);
492 err = idr_alloc_u32(&tn->idr, block, &block->index, block->index,
493 GFP_NOWAIT);
494 spin_unlock(&tn->idr_lock);
495 idr_preload_end();
496
497 return err;
Jiri Pirkoa9b19442018-01-17 11:46:45 +0100498}
499
Jiri Pirko48617382018-01-17 11:46:46 +0100500static void tcf_block_remove(struct tcf_block *block, struct net *net)
Jiri Pirko6529eab2017-05-17 11:07:55 +0200501{
Jiri Pirko48617382018-01-17 11:46:46 +0100502 struct tcf_net *tn = net_generic(net, tcf_net_id);
503
Vlad Buslovab281622018-09-24 19:22:56 +0300504 spin_lock(&tn->idr_lock);
Matthew Wilcox9c160942017-11-28 09:48:43 -0500505 idr_remove(&tn->idr, block->index);
Vlad Buslovab281622018-09-24 19:22:56 +0300506 spin_unlock(&tn->idr_lock);
Jiri Pirko48617382018-01-17 11:46:46 +0100507}
508
509static struct tcf_block *tcf_block_create(struct net *net, struct Qdisc *q,
Jiri Pirkobb047dd2018-02-13 12:00:16 +0100510 u32 block_index,
Jiri Pirko48617382018-01-17 11:46:46 +0100511 struct netlink_ext_ack *extack)
512{
513 struct tcf_block *block;
Jiri Pirko6529eab2017-05-17 11:07:55 +0200514
Jiri Pirko48617382018-01-17 11:46:46 +0100515 block = kzalloc(sizeof(*block), GFP_KERNEL);
Alexander Aring8d1a77f2017-12-20 12:35:19 -0500516 if (!block) {
517 NL_SET_ERR_MSG(extack, "Memory allocation for block failed");
Jiri Pirko48617382018-01-17 11:46:46 +0100518 return ERR_PTR(-ENOMEM);
Alexander Aring8d1a77f2017-12-20 12:35:19 -0500519 }
Jiri Pirko5bc17012017-05-17 11:08:01 +0200520 INIT_LIST_HEAD(&block->chain_list);
Jiri Pirkoacb67442017-10-19 15:50:31 +0200521 INIT_LIST_HEAD(&block->cb_list);
Jiri Pirkof36fe1c2018-01-17 11:46:48 +0100522 INIT_LIST_HEAD(&block->owner_list);
Jiri Pirkof71e0ca42018-07-23 09:23:05 +0200523 INIT_LIST_HEAD(&block->chain0.filter_chain_list);
Jiri Pirkoacb67442017-10-19 15:50:31 +0200524
Vlad Buslovcfebd7e2018-09-24 19:22:54 +0300525 refcount_set(&block->refcnt, 1);
Jiri Pirko48617382018-01-17 11:46:46 +0100526 block->net = net;
Jiri Pirkobb047dd2018-02-13 12:00:16 +0100527 block->index = block_index;
528
529 /* Don't store q pointer for blocks which are shared */
530 if (!tcf_block_shared(block))
531 block->q = q;
Jiri Pirko48617382018-01-17 11:46:46 +0100532 return block;
Jiri Pirko48617382018-01-17 11:46:46 +0100533}
534
535static struct tcf_block *tcf_block_lookup(struct net *net, u32 block_index)
536{
537 struct tcf_net *tn = net_generic(net, tcf_net_id);
538
Matthew Wilcox322d8842017-11-28 10:01:24 -0500539 return idr_find(&tn->idr, block_index);
Jiri Pirko48617382018-01-17 11:46:46 +0100540}
541
Vlad Buslov0607e432018-09-24 19:22:57 +0300542static struct tcf_block *tcf_block_refcnt_get(struct net *net, u32 block_index)
543{
544 struct tcf_block *block;
545
546 rcu_read_lock();
547 block = tcf_block_lookup(net, block_index);
548 if (block && !refcount_inc_not_zero(&block->refcnt))
549 block = NULL;
550 rcu_read_unlock();
551
552 return block;
553}
554
Vlad Buslovf0023432018-09-24 19:22:55 +0300555static void tcf_block_flush_all_chains(struct tcf_block *block)
556{
557 struct tcf_chain *chain;
558
559 /* Hold a refcnt for all chains, so that they don't disappear
560 * while we are iterating.
561 */
562 list_for_each_entry(chain, &block->chain_list, list)
563 tcf_chain_hold(chain);
564
565 list_for_each_entry(chain, &block->chain_list, list)
566 tcf_chain_flush(chain);
567}
568
569static void tcf_block_put_all_chains(struct tcf_block *block)
570{
571 struct tcf_chain *chain, *tmp;
572
573 /* At this point, all the chains should have refcnt >= 1. */
574 list_for_each_entry_safe(chain, tmp, &block->chain_list, list) {
575 tcf_chain_put_explicitly_created(chain);
576 tcf_chain_put(chain);
577 }
578}
579
Vlad Buslov0607e432018-09-24 19:22:57 +0300580static void __tcf_block_put(struct tcf_block *block, struct Qdisc *q,
581 struct tcf_block_ext_info *ei)
582{
583 if (refcount_dec_and_test(&block->refcnt)) {
584 /* Flushing/putting all chains will cause the block to be
585 * deallocated when last chain is freed. However, if chain_list
586 * is empty, block has to be manually deallocated. After block
587 * reference counter reached 0, it is no longer possible to
588 * increment it or add new chains to block.
589 */
590 bool free_block = list_empty(&block->chain_list);
591
592 if (tcf_block_shared(block))
593 tcf_block_remove(block, block->net);
594 if (!free_block)
595 tcf_block_flush_all_chains(block);
596
597 if (q)
598 tcf_block_offload_unbind(block, q, ei);
599
600 if (free_block)
601 kfree_rcu(block, rcu);
602 else
603 tcf_block_put_all_chains(block);
604 } else if (q) {
605 tcf_block_offload_unbind(block, q, ei);
606 }
607}
608
609static void tcf_block_refcnt_put(struct tcf_block *block)
610{
611 __tcf_block_put(block, NULL, NULL);
612}
613
Vlad Buslovc431f892018-05-31 09:52:53 +0300614/* Find tcf block.
615 * Set q, parent, cl when appropriate.
616 */
617
618static struct tcf_block *tcf_block_find(struct net *net, struct Qdisc **q,
619 u32 *parent, unsigned long *cl,
620 int ifindex, u32 block_index,
621 struct netlink_ext_ack *extack)
622{
623 struct tcf_block *block;
Vlad Buslove368fdb2018-09-24 19:22:53 +0300624 int err = 0;
Vlad Buslovc431f892018-05-31 09:52:53 +0300625
626 if (ifindex == TCM_IFINDEX_MAGIC_BLOCK) {
Vlad Buslov787ce6d2018-09-24 19:22:58 +0300627 block = tcf_block_refcnt_get(net, block_index);
Vlad Buslovc431f892018-05-31 09:52:53 +0300628 if (!block) {
629 NL_SET_ERR_MSG(extack, "Block of given index was not found");
630 return ERR_PTR(-EINVAL);
631 }
632 } else {
633 const struct Qdisc_class_ops *cops;
634 struct net_device *dev;
635
Vlad Buslove368fdb2018-09-24 19:22:53 +0300636 rcu_read_lock();
637
Vlad Buslovc431f892018-05-31 09:52:53 +0300638 /* Find link */
Vlad Buslove368fdb2018-09-24 19:22:53 +0300639 dev = dev_get_by_index_rcu(net, ifindex);
640 if (!dev) {
641 rcu_read_unlock();
Vlad Buslovc431f892018-05-31 09:52:53 +0300642 return ERR_PTR(-ENODEV);
Vlad Buslove368fdb2018-09-24 19:22:53 +0300643 }
Vlad Buslovc431f892018-05-31 09:52:53 +0300644
645 /* Find qdisc */
646 if (!*parent) {
647 *q = dev->qdisc;
648 *parent = (*q)->handle;
649 } else {
Vlad Buslove368fdb2018-09-24 19:22:53 +0300650 *q = qdisc_lookup_rcu(dev, TC_H_MAJ(*parent));
Vlad Buslovc431f892018-05-31 09:52:53 +0300651 if (!*q) {
652 NL_SET_ERR_MSG(extack, "Parent Qdisc doesn't exists");
Vlad Buslove368fdb2018-09-24 19:22:53 +0300653 err = -EINVAL;
654 goto errout_rcu;
Vlad Buslovc431f892018-05-31 09:52:53 +0300655 }
656 }
657
Vlad Buslove368fdb2018-09-24 19:22:53 +0300658 *q = qdisc_refcount_inc_nz(*q);
659 if (!*q) {
660 NL_SET_ERR_MSG(extack, "Parent Qdisc doesn't exists");
661 err = -EINVAL;
662 goto errout_rcu;
663 }
664
Vlad Buslovc431f892018-05-31 09:52:53 +0300665 /* Is it classful? */
666 cops = (*q)->ops->cl_ops;
667 if (!cops) {
668 NL_SET_ERR_MSG(extack, "Qdisc not classful");
Vlad Buslove368fdb2018-09-24 19:22:53 +0300669 err = -EINVAL;
670 goto errout_rcu;
Vlad Buslovc431f892018-05-31 09:52:53 +0300671 }
672
673 if (!cops->tcf_block) {
674 NL_SET_ERR_MSG(extack, "Class doesn't support blocks");
Vlad Buslove368fdb2018-09-24 19:22:53 +0300675 err = -EOPNOTSUPP;
676 goto errout_rcu;
Vlad Buslovc431f892018-05-31 09:52:53 +0300677 }
678
Vlad Buslove368fdb2018-09-24 19:22:53 +0300679 /* At this point we know that qdisc is not noop_qdisc,
680 * which means that qdisc holds a reference to net_device
681 * and we hold a reference to qdisc, so it is safe to release
682 * rcu read lock.
683 */
684 rcu_read_unlock();
685
Vlad Buslovc431f892018-05-31 09:52:53 +0300686 /* Do we search for filter, attached to class? */
687 if (TC_H_MIN(*parent)) {
688 *cl = cops->find(*q, *parent);
689 if (*cl == 0) {
690 NL_SET_ERR_MSG(extack, "Specified class doesn't exist");
Vlad Buslove368fdb2018-09-24 19:22:53 +0300691 err = -ENOENT;
692 goto errout_qdisc;
Vlad Buslovc431f892018-05-31 09:52:53 +0300693 }
694 }
695
696 /* And the last stroke */
697 block = cops->tcf_block(*q, *cl, extack);
Vlad Buslove368fdb2018-09-24 19:22:53 +0300698 if (!block) {
699 err = -EINVAL;
700 goto errout_qdisc;
701 }
Vlad Buslovc431f892018-05-31 09:52:53 +0300702 if (tcf_block_shared(block)) {
703 NL_SET_ERR_MSG(extack, "This filter block is shared. Please use the block index to manipulate the filters");
Vlad Buslove368fdb2018-09-24 19:22:53 +0300704 err = -EOPNOTSUPP;
705 goto errout_qdisc;
Vlad Buslovc431f892018-05-31 09:52:53 +0300706 }
Vlad Buslov787ce6d2018-09-24 19:22:58 +0300707
708 /* Always take reference to block in order to support execution
709 * of rules update path of cls API without rtnl lock. Caller
710 * must release block when it is finished using it. 'if' block
711 * of this conditional obtain reference to block by calling
712 * tcf_block_refcnt_get().
713 */
714 refcount_inc(&block->refcnt);
Vlad Buslovc431f892018-05-31 09:52:53 +0300715 }
716
717 return block;
Vlad Buslove368fdb2018-09-24 19:22:53 +0300718
719errout_rcu:
720 rcu_read_unlock();
721errout_qdisc:
Cong Wang460b3602018-09-27 13:42:19 -0700722 if (*q) {
Vlad Buslove368fdb2018-09-24 19:22:53 +0300723 qdisc_put(*q);
Cong Wang460b3602018-09-27 13:42:19 -0700724 *q = NULL;
725 }
Vlad Buslove368fdb2018-09-24 19:22:53 +0300726 return ERR_PTR(err);
727}
728
729static void tcf_block_release(struct Qdisc *q, struct tcf_block *block)
730{
Vlad Buslov787ce6d2018-09-24 19:22:58 +0300731 if (!IS_ERR_OR_NULL(block))
732 tcf_block_refcnt_put(block);
733
Vlad Buslove368fdb2018-09-24 19:22:53 +0300734 if (q)
735 qdisc_put(q);
Vlad Buslovc431f892018-05-31 09:52:53 +0300736}
737
Jiri Pirkof36fe1c2018-01-17 11:46:48 +0100738struct tcf_block_owner_item {
739 struct list_head list;
740 struct Qdisc *q;
741 enum tcf_block_binder_type binder_type;
742};
743
744static void
745tcf_block_owner_netif_keep_dst(struct tcf_block *block,
746 struct Qdisc *q,
747 enum tcf_block_binder_type binder_type)
748{
749 if (block->keep_dst &&
750 binder_type != TCF_BLOCK_BINDER_TYPE_CLSACT_INGRESS &&
751 binder_type != TCF_BLOCK_BINDER_TYPE_CLSACT_EGRESS)
752 netif_keep_dst(qdisc_dev(q));
753}
754
755void tcf_block_netif_keep_dst(struct tcf_block *block)
756{
757 struct tcf_block_owner_item *item;
758
759 block->keep_dst = true;
760 list_for_each_entry(item, &block->owner_list, list)
761 tcf_block_owner_netif_keep_dst(block, item->q,
762 item->binder_type);
763}
764EXPORT_SYMBOL(tcf_block_netif_keep_dst);
765
766static int tcf_block_owner_add(struct tcf_block *block,
767 struct Qdisc *q,
768 enum tcf_block_binder_type binder_type)
769{
770 struct tcf_block_owner_item *item;
771
772 item = kmalloc(sizeof(*item), GFP_KERNEL);
773 if (!item)
774 return -ENOMEM;
775 item->q = q;
776 item->binder_type = binder_type;
777 list_add(&item->list, &block->owner_list);
778 return 0;
779}
780
781static void tcf_block_owner_del(struct tcf_block *block,
782 struct Qdisc *q,
783 enum tcf_block_binder_type binder_type)
784{
785 struct tcf_block_owner_item *item;
786
787 list_for_each_entry(item, &block->owner_list, list) {
788 if (item->q == q && item->binder_type == binder_type) {
789 list_del(&item->list);
790 kfree(item);
791 return;
792 }
793 }
794 WARN_ON(1);
795}
796
Jiri Pirko48617382018-01-17 11:46:46 +0100797int tcf_block_get_ext(struct tcf_block **p_block, struct Qdisc *q,
798 struct tcf_block_ext_info *ei,
799 struct netlink_ext_ack *extack)
800{
801 struct net *net = qdisc_net(q);
802 struct tcf_block *block = NULL;
Jiri Pirko48617382018-01-17 11:46:46 +0100803 int err;
804
Vlad Buslov787ce6d2018-09-24 19:22:58 +0300805 if (ei->block_index)
Jiri Pirko48617382018-01-17 11:46:46 +0100806 /* block_index not 0 means the shared block is requested */
Vlad Buslov787ce6d2018-09-24 19:22:58 +0300807 block = tcf_block_refcnt_get(net, ei->block_index);
Jiri Pirko48617382018-01-17 11:46:46 +0100808
809 if (!block) {
Jiri Pirkobb047dd2018-02-13 12:00:16 +0100810 block = tcf_block_create(net, q, ei->block_index, extack);
Jiri Pirko48617382018-01-17 11:46:46 +0100811 if (IS_ERR(block))
812 return PTR_ERR(block);
Jiri Pirkobb047dd2018-02-13 12:00:16 +0100813 if (tcf_block_shared(block)) {
814 err = tcf_block_insert(block, net, extack);
Jiri Pirko48617382018-01-17 11:46:46 +0100815 if (err)
816 goto err_block_insert;
817 }
818 }
819
Jiri Pirkof36fe1c2018-01-17 11:46:48 +0100820 err = tcf_block_owner_add(block, q, ei->binder_type);
821 if (err)
822 goto err_block_owner_add;
823
824 tcf_block_owner_netif_keep_dst(block, q, ei->binder_type);
825
Jiri Pirkof71e0ca42018-07-23 09:23:05 +0200826 err = tcf_chain0_head_change_cb_add(block, ei, extack);
Jiri Pirkoa9b19442018-01-17 11:46:45 +0100827 if (err)
Jiri Pirkof71e0ca42018-07-23 09:23:05 +0200828 goto err_chain0_head_change_cb_add;
Jiri Pirkocaa72602018-01-17 11:46:50 +0100829
John Hurley60513bd2018-06-25 14:30:04 -0700830 err = tcf_block_offload_bind(block, q, ei, extack);
Jiri Pirkocaa72602018-01-17 11:46:50 +0100831 if (err)
832 goto err_block_offload_bind;
833
Jiri Pirko6529eab2017-05-17 11:07:55 +0200834 *p_block = block;
835 return 0;
Jiri Pirko2190d1d2017-05-17 11:07:59 +0200836
Jiri Pirkocaa72602018-01-17 11:46:50 +0100837err_block_offload_bind:
Jiri Pirkof71e0ca42018-07-23 09:23:05 +0200838 tcf_chain0_head_change_cb_del(block, ei);
839err_chain0_head_change_cb_add:
Jiri Pirkof36fe1c2018-01-17 11:46:48 +0100840 tcf_block_owner_del(block, q, ei->binder_type);
841err_block_owner_add:
Jiri Pirko48617382018-01-17 11:46:46 +0100842err_block_insert:
Vlad Buslov787ce6d2018-09-24 19:22:58 +0300843 tcf_block_refcnt_put(block);
Jiri Pirko2190d1d2017-05-17 11:07:59 +0200844 return err;
Jiri Pirko6529eab2017-05-17 11:07:55 +0200845}
Jiri Pirko8c4083b2017-10-19 15:50:29 +0200846EXPORT_SYMBOL(tcf_block_get_ext);
847
Jiri Pirkoc7eb7d72017-11-03 11:46:24 +0100848static void tcf_chain_head_change_dflt(struct tcf_proto *tp_head, void *priv)
849{
850 struct tcf_proto __rcu **p_filter_chain = priv;
851
852 rcu_assign_pointer(*p_filter_chain, tp_head);
853}
854
Jiri Pirko8c4083b2017-10-19 15:50:29 +0200855int tcf_block_get(struct tcf_block **p_block,
Alexander Aring8d1a77f2017-12-20 12:35:19 -0500856 struct tcf_proto __rcu **p_filter_chain, struct Qdisc *q,
857 struct netlink_ext_ack *extack)
Jiri Pirko8c4083b2017-10-19 15:50:29 +0200858{
Jiri Pirkoc7eb7d72017-11-03 11:46:24 +0100859 struct tcf_block_ext_info ei = {
860 .chain_head_change = tcf_chain_head_change_dflt,
861 .chain_head_change_priv = p_filter_chain,
862 };
Jiri Pirko8c4083b2017-10-19 15:50:29 +0200863
Jiri Pirkoc7eb7d72017-11-03 11:46:24 +0100864 WARN_ON(!p_filter_chain);
Alexander Aring8d1a77f2017-12-20 12:35:19 -0500865 return tcf_block_get_ext(p_block, q, &ei, extack);
Jiri Pirko8c4083b2017-10-19 15:50:29 +0200866}
Jiri Pirko6529eab2017-05-17 11:07:55 +0200867EXPORT_SYMBOL(tcf_block_get);
868
Cong Wang7aa00452017-10-26 18:24:28 -0700869/* XXX: Standalone actions are not allowed to jump to any chain, and bound
Roman Kapla60b3f52017-11-24 12:27:58 +0100870 * actions should be all removed after flushing.
Cong Wang7aa00452017-10-26 18:24:28 -0700871 */
Jiri Pirkoc7eb7d72017-11-03 11:46:24 +0100872void tcf_block_put_ext(struct tcf_block *block, struct Qdisc *q,
David S. Millere1ea2f92017-10-30 14:10:01 +0900873 struct tcf_block_ext_info *ei)
Cong Wang7aa00452017-10-26 18:24:28 -0700874{
David S. Millerc30abd52017-12-16 22:11:55 -0500875 if (!block)
876 return;
Jiri Pirkof71e0ca42018-07-23 09:23:05 +0200877 tcf_chain0_head_change_cb_del(block, ei);
Jiri Pirkof36fe1c2018-01-17 11:46:48 +0100878 tcf_block_owner_del(block, q, ei->binder_type);
Roman Kapla60b3f52017-11-24 12:27:58 +0100879
Vlad Buslov0607e432018-09-24 19:22:57 +0300880 __tcf_block_put(block, q, ei);
Jiri Pirko6529eab2017-05-17 11:07:55 +0200881}
Jiri Pirko8c4083b2017-10-19 15:50:29 +0200882EXPORT_SYMBOL(tcf_block_put_ext);
883
884void tcf_block_put(struct tcf_block *block)
885{
886 struct tcf_block_ext_info ei = {0, };
887
Jiri Pirko4853f122017-12-21 13:13:59 +0100888 if (!block)
889 return;
Jiri Pirkoc7eb7d72017-11-03 11:46:24 +0100890 tcf_block_put_ext(block, block->q, &ei);
Jiri Pirko8c4083b2017-10-19 15:50:29 +0200891}
David S. Millere1ea2f92017-10-30 14:10:01 +0900892
Jiri Pirko6529eab2017-05-17 11:07:55 +0200893EXPORT_SYMBOL(tcf_block_put);
Jiri Pirkocf1facd2017-02-09 14:38:56 +0100894
Jiri Pirkoacb67442017-10-19 15:50:31 +0200895struct tcf_block_cb {
896 struct list_head list;
897 tc_setup_cb_t *cb;
898 void *cb_ident;
899 void *cb_priv;
900 unsigned int refcnt;
901};
902
903void *tcf_block_cb_priv(struct tcf_block_cb *block_cb)
904{
905 return block_cb->cb_priv;
906}
907EXPORT_SYMBOL(tcf_block_cb_priv);
908
909struct tcf_block_cb *tcf_block_cb_lookup(struct tcf_block *block,
910 tc_setup_cb_t *cb, void *cb_ident)
911{ struct tcf_block_cb *block_cb;
912
913 list_for_each_entry(block_cb, &block->cb_list, list)
914 if (block_cb->cb == cb && block_cb->cb_ident == cb_ident)
915 return block_cb;
916 return NULL;
917}
918EXPORT_SYMBOL(tcf_block_cb_lookup);
919
920void tcf_block_cb_incref(struct tcf_block_cb *block_cb)
921{
922 block_cb->refcnt++;
923}
924EXPORT_SYMBOL(tcf_block_cb_incref);
925
926unsigned int tcf_block_cb_decref(struct tcf_block_cb *block_cb)
927{
928 return --block_cb->refcnt;
929}
930EXPORT_SYMBOL(tcf_block_cb_decref);
931
John Hurley32636742018-06-25 14:30:10 -0700932static int
933tcf_block_playback_offloads(struct tcf_block *block, tc_setup_cb_t *cb,
934 void *cb_priv, bool add, bool offload_in_use,
935 struct netlink_ext_ack *extack)
936{
937 struct tcf_chain *chain;
938 struct tcf_proto *tp;
939 int err;
940
941 list_for_each_entry(chain, &block->chain_list, list) {
942 for (tp = rtnl_dereference(chain->filter_chain); tp;
943 tp = rtnl_dereference(tp->next)) {
944 if (tp->ops->reoffload) {
945 err = tp->ops->reoffload(tp, add, cb, cb_priv,
946 extack);
947 if (err && add)
948 goto err_playback_remove;
949 } else if (add && offload_in_use) {
950 err = -EOPNOTSUPP;
951 NL_SET_ERR_MSG(extack, "Filter HW offload failed - classifier without re-offloading support");
952 goto err_playback_remove;
953 }
954 }
955 }
956
957 return 0;
958
959err_playback_remove:
960 tcf_block_playback_offloads(block, cb, cb_priv, false, offload_in_use,
961 extack);
962 return err;
963}
964
Jiri Pirkoacb67442017-10-19 15:50:31 +0200965struct tcf_block_cb *__tcf_block_cb_register(struct tcf_block *block,
966 tc_setup_cb_t *cb, void *cb_ident,
John Hurley60513bd2018-06-25 14:30:04 -0700967 void *cb_priv,
968 struct netlink_ext_ack *extack)
Jiri Pirkoacb67442017-10-19 15:50:31 +0200969{
970 struct tcf_block_cb *block_cb;
John Hurley32636742018-06-25 14:30:10 -0700971 int err;
Jiri Pirkoacb67442017-10-19 15:50:31 +0200972
John Hurley32636742018-06-25 14:30:10 -0700973 /* Replay any already present rules */
974 err = tcf_block_playback_offloads(block, cb, cb_priv, true,
975 tcf_block_offload_in_use(block),
976 extack);
977 if (err)
978 return ERR_PTR(err);
Jiri Pirkocaa72602018-01-17 11:46:50 +0100979
Jiri Pirkoacb67442017-10-19 15:50:31 +0200980 block_cb = kzalloc(sizeof(*block_cb), GFP_KERNEL);
981 if (!block_cb)
Jiri Pirkocaa72602018-01-17 11:46:50 +0100982 return ERR_PTR(-ENOMEM);
Jiri Pirkoacb67442017-10-19 15:50:31 +0200983 block_cb->cb = cb;
984 block_cb->cb_ident = cb_ident;
985 block_cb->cb_priv = cb_priv;
986 list_add(&block_cb->list, &block->cb_list);
987 return block_cb;
988}
989EXPORT_SYMBOL(__tcf_block_cb_register);
990
991int tcf_block_cb_register(struct tcf_block *block,
992 tc_setup_cb_t *cb, void *cb_ident,
John Hurley60513bd2018-06-25 14:30:04 -0700993 void *cb_priv, struct netlink_ext_ack *extack)
Jiri Pirkoacb67442017-10-19 15:50:31 +0200994{
995 struct tcf_block_cb *block_cb;
996
John Hurley60513bd2018-06-25 14:30:04 -0700997 block_cb = __tcf_block_cb_register(block, cb, cb_ident, cb_priv,
998 extack);
Gustavo A. R. Silvabaa2d2b2018-07-18 23:14:17 -0500999 return PTR_ERR_OR_ZERO(block_cb);
Jiri Pirkoacb67442017-10-19 15:50:31 +02001000}
1001EXPORT_SYMBOL(tcf_block_cb_register);
1002
John Hurley32636742018-06-25 14:30:10 -07001003void __tcf_block_cb_unregister(struct tcf_block *block,
1004 struct tcf_block_cb *block_cb)
Jiri Pirkoacb67442017-10-19 15:50:31 +02001005{
John Hurley32636742018-06-25 14:30:10 -07001006 tcf_block_playback_offloads(block, block_cb->cb, block_cb->cb_priv,
1007 false, tcf_block_offload_in_use(block),
1008 NULL);
Jiri Pirkoacb67442017-10-19 15:50:31 +02001009 list_del(&block_cb->list);
1010 kfree(block_cb);
1011}
1012EXPORT_SYMBOL(__tcf_block_cb_unregister);
1013
1014void tcf_block_cb_unregister(struct tcf_block *block,
1015 tc_setup_cb_t *cb, void *cb_ident)
1016{
1017 struct tcf_block_cb *block_cb;
1018
1019 block_cb = tcf_block_cb_lookup(block, cb, cb_ident);
1020 if (!block_cb)
1021 return;
John Hurley32636742018-06-25 14:30:10 -07001022 __tcf_block_cb_unregister(block, block_cb);
Jiri Pirkoacb67442017-10-19 15:50:31 +02001023}
1024EXPORT_SYMBOL(tcf_block_cb_unregister);
1025
1026static int tcf_block_cb_call(struct tcf_block *block, enum tc_setup_type type,
1027 void *type_data, bool err_stop)
1028{
1029 struct tcf_block_cb *block_cb;
1030 int ok_count = 0;
1031 int err;
1032
David S. Miller9a99dc12018-06-06 13:55:47 -04001033 /* Make sure all netdevs sharing this block are offload-capable. */
1034 if (block->nooffloaddevcnt && err_stop)
1035 return -EOPNOTSUPP;
1036
Jiri Pirkoacb67442017-10-19 15:50:31 +02001037 list_for_each_entry(block_cb, &block->cb_list, list) {
1038 err = block_cb->cb(type, type_data, block_cb->cb_priv);
1039 if (err) {
1040 if (err_stop)
1041 return err;
1042 } else {
1043 ok_count++;
1044 }
1045 }
1046 return ok_count;
1047}
1048
Jiri Pirko87d83092017-05-17 11:07:54 +02001049/* Main classifier routine: scans classifier chain attached
1050 * to this qdisc, (optionally) tests for protocol and asks
1051 * specific classifiers.
1052 */
1053int tcf_classify(struct sk_buff *skb, const struct tcf_proto *tp,
1054 struct tcf_result *res, bool compat_mode)
1055{
1056 __be16 protocol = tc_skb_protocol(skb);
1057#ifdef CONFIG_NET_CLS_ACT
1058 const int max_reclassify_loop = 4;
Jiri Pirkoee538dc2017-05-23 09:11:59 +02001059 const struct tcf_proto *orig_tp = tp;
1060 const struct tcf_proto *first_tp;
Jiri Pirko87d83092017-05-17 11:07:54 +02001061 int limit = 0;
1062
1063reclassify:
1064#endif
1065 for (; tp; tp = rcu_dereference_bh(tp->next)) {
1066 int err;
1067
1068 if (tp->protocol != protocol &&
1069 tp->protocol != htons(ETH_P_ALL))
1070 continue;
1071
1072 err = tp->classify(skb, tp, res);
1073#ifdef CONFIG_NET_CLS_ACT
Jiri Pirkodb505142017-05-17 11:08:03 +02001074 if (unlikely(err == TC_ACT_RECLASSIFY && !compat_mode)) {
Jiri Pirkoee538dc2017-05-23 09:11:59 +02001075 first_tp = orig_tp;
Jiri Pirko87d83092017-05-17 11:07:54 +02001076 goto reset;
Jiri Pirkodb505142017-05-17 11:08:03 +02001077 } else if (unlikely(TC_ACT_EXT_CMP(err, TC_ACT_GOTO_CHAIN))) {
Jiri Pirkoee538dc2017-05-23 09:11:59 +02001078 first_tp = res->goto_tp;
Jiri Pirkodb505142017-05-17 11:08:03 +02001079 goto reset;
1080 }
Jiri Pirko87d83092017-05-17 11:07:54 +02001081#endif
1082 if (err >= 0)
1083 return err;
1084 }
1085
1086 return TC_ACT_UNSPEC; /* signal: continue lookup */
1087#ifdef CONFIG_NET_CLS_ACT
1088reset:
1089 if (unlikely(limit++ >= max_reclassify_loop)) {
Jiri Pirko9d3aaff2018-01-17 11:46:47 +01001090 net_notice_ratelimited("%u: reclassify loop, rule prio %u, protocol %02x\n",
1091 tp->chain->block->index,
1092 tp->prio & 0xffff,
Jiri Pirko87d83092017-05-17 11:07:54 +02001093 ntohs(tp->protocol));
1094 return TC_ACT_SHOT;
1095 }
1096
Jiri Pirkoee538dc2017-05-23 09:11:59 +02001097 tp = first_tp;
Jiri Pirko87d83092017-05-17 11:07:54 +02001098 protocol = tc_skb_protocol(skb);
1099 goto reclassify;
1100#endif
1101}
1102EXPORT_SYMBOL(tcf_classify);
1103
Jiri Pirko2190d1d2017-05-17 11:07:59 +02001104struct tcf_chain_info {
1105 struct tcf_proto __rcu **pprev;
1106 struct tcf_proto __rcu *next;
1107};
1108
1109static struct tcf_proto *tcf_chain_tp_prev(struct tcf_chain_info *chain_info)
1110{
1111 return rtnl_dereference(*chain_info->pprev);
1112}
1113
1114static void tcf_chain_tp_insert(struct tcf_chain *chain,
1115 struct tcf_chain_info *chain_info,
1116 struct tcf_proto *tp)
1117{
Jiri Pirkoc7eb7d72017-11-03 11:46:24 +01001118 if (*chain_info->pprev == chain->filter_chain)
Jiri Pirkof71e0ca42018-07-23 09:23:05 +02001119 tcf_chain0_head_change(chain, tp);
Jiri Pirko2190d1d2017-05-17 11:07:59 +02001120 RCU_INIT_POINTER(tp->next, tcf_chain_tp_prev(chain_info));
1121 rcu_assign_pointer(*chain_info->pprev, tp);
Cong Wange2ef7542017-09-11 16:33:31 -07001122 tcf_chain_hold(chain);
Jiri Pirko2190d1d2017-05-17 11:07:59 +02001123}
1124
1125static void tcf_chain_tp_remove(struct tcf_chain *chain,
1126 struct tcf_chain_info *chain_info,
1127 struct tcf_proto *tp)
1128{
1129 struct tcf_proto *next = rtnl_dereference(chain_info->next);
1130
Jiri Pirkoc7eb7d72017-11-03 11:46:24 +01001131 if (tp == chain->filter_chain)
Jiri Pirkof71e0ca42018-07-23 09:23:05 +02001132 tcf_chain0_head_change(chain, next);
Jiri Pirko2190d1d2017-05-17 11:07:59 +02001133 RCU_INIT_POINTER(*chain_info->pprev, next);
Cong Wange2ef7542017-09-11 16:33:31 -07001134 tcf_chain_put(chain);
Jiri Pirko2190d1d2017-05-17 11:07:59 +02001135}
1136
1137static struct tcf_proto *tcf_chain_tp_find(struct tcf_chain *chain,
1138 struct tcf_chain_info *chain_info,
1139 u32 protocol, u32 prio,
1140 bool prio_allocate)
1141{
1142 struct tcf_proto **pprev;
1143 struct tcf_proto *tp;
1144
1145 /* Check the chain for existence of proto-tcf with this priority */
1146 for (pprev = &chain->filter_chain;
1147 (tp = rtnl_dereference(*pprev)); pprev = &tp->next) {
1148 if (tp->prio >= prio) {
1149 if (tp->prio == prio) {
1150 if (prio_allocate ||
1151 (tp->protocol != protocol && protocol))
1152 return ERR_PTR(-EINVAL);
1153 } else {
1154 tp = NULL;
1155 }
1156 break;
1157 }
1158 }
1159 chain_info->pprev = pprev;
1160 chain_info->next = tp ? tp->next : NULL;
1161 return tp;
1162}
1163
WANG Cong71203712017-08-07 15:26:50 -07001164static int tcf_fill_node(struct net *net, struct sk_buff *skb,
Jiri Pirko7960d1d2018-01-17 11:46:51 +01001165 struct tcf_proto *tp, struct tcf_block *block,
1166 struct Qdisc *q, u32 parent, void *fh,
1167 u32 portid, u32 seq, u16 flags, int event)
WANG Cong71203712017-08-07 15:26:50 -07001168{
1169 struct tcmsg *tcm;
1170 struct nlmsghdr *nlh;
1171 unsigned char *b = skb_tail_pointer(skb);
1172
1173 nlh = nlmsg_put(skb, portid, seq, event, sizeof(*tcm), flags);
1174 if (!nlh)
1175 goto out_nlmsg_trim;
1176 tcm = nlmsg_data(nlh);
1177 tcm->tcm_family = AF_UNSPEC;
1178 tcm->tcm__pad1 = 0;
1179 tcm->tcm__pad2 = 0;
Jiri Pirko7960d1d2018-01-17 11:46:51 +01001180 if (q) {
1181 tcm->tcm_ifindex = qdisc_dev(q)->ifindex;
1182 tcm->tcm_parent = parent;
1183 } else {
1184 tcm->tcm_ifindex = TCM_IFINDEX_MAGIC_BLOCK;
1185 tcm->tcm_block_index = block->index;
1186 }
WANG Cong71203712017-08-07 15:26:50 -07001187 tcm->tcm_info = TC_H_MAKE(tp->prio, tp->protocol);
1188 if (nla_put_string(skb, TCA_KIND, tp->ops->kind))
1189 goto nla_put_failure;
1190 if (nla_put_u32(skb, TCA_CHAIN, tp->chain->index))
1191 goto nla_put_failure;
1192 if (!fh) {
1193 tcm->tcm_handle = 0;
1194 } else {
1195 if (tp->ops->dump && tp->ops->dump(net, tp, fh, skb, tcm) < 0)
1196 goto nla_put_failure;
1197 }
1198 nlh->nlmsg_len = skb_tail_pointer(skb) - b;
1199 return skb->len;
1200
1201out_nlmsg_trim:
1202nla_put_failure:
1203 nlmsg_trim(skb, b);
1204 return -1;
1205}
1206
1207static int tfilter_notify(struct net *net, struct sk_buff *oskb,
1208 struct nlmsghdr *n, struct tcf_proto *tp,
Jiri Pirko7960d1d2018-01-17 11:46:51 +01001209 struct tcf_block *block, struct Qdisc *q,
1210 u32 parent, void *fh, int event, bool unicast)
WANG Cong71203712017-08-07 15:26:50 -07001211{
1212 struct sk_buff *skb;
1213 u32 portid = oskb ? NETLINK_CB(oskb).portid : 0;
1214
1215 skb = alloc_skb(NLMSG_GOODSIZE, GFP_KERNEL);
1216 if (!skb)
1217 return -ENOBUFS;
1218
Jiri Pirko7960d1d2018-01-17 11:46:51 +01001219 if (tcf_fill_node(net, skb, tp, block, q, parent, fh, portid,
1220 n->nlmsg_seq, n->nlmsg_flags, event) <= 0) {
WANG Cong71203712017-08-07 15:26:50 -07001221 kfree_skb(skb);
1222 return -EINVAL;
1223 }
1224
1225 if (unicast)
1226 return netlink_unicast(net->rtnl, skb, portid, MSG_DONTWAIT);
1227
1228 return rtnetlink_send(skb, net, portid, RTNLGRP_TC,
1229 n->nlmsg_flags & NLM_F_ECHO);
1230}
1231
1232static int tfilter_del_notify(struct net *net, struct sk_buff *oskb,
1233 struct nlmsghdr *n, struct tcf_proto *tp,
Jiri Pirko7960d1d2018-01-17 11:46:51 +01001234 struct tcf_block *block, struct Qdisc *q,
Alexander Aringc35a4ac2018-01-18 11:20:50 -05001235 u32 parent, void *fh, bool unicast, bool *last,
1236 struct netlink_ext_ack *extack)
WANG Cong71203712017-08-07 15:26:50 -07001237{
1238 struct sk_buff *skb;
1239 u32 portid = oskb ? NETLINK_CB(oskb).portid : 0;
1240 int err;
1241
1242 skb = alloc_skb(NLMSG_GOODSIZE, GFP_KERNEL);
1243 if (!skb)
1244 return -ENOBUFS;
1245
Jiri Pirko7960d1d2018-01-17 11:46:51 +01001246 if (tcf_fill_node(net, skb, tp, block, q, parent, fh, portid,
1247 n->nlmsg_seq, n->nlmsg_flags, RTM_DELTFILTER) <= 0) {
Alexander Aringc35a4ac2018-01-18 11:20:50 -05001248 NL_SET_ERR_MSG(extack, "Failed to build del event notification");
WANG Cong71203712017-08-07 15:26:50 -07001249 kfree_skb(skb);
1250 return -EINVAL;
1251 }
1252
Alexander Aring571acf22018-01-18 11:20:53 -05001253 err = tp->ops->delete(tp, fh, last, extack);
WANG Cong71203712017-08-07 15:26:50 -07001254 if (err) {
1255 kfree_skb(skb);
1256 return err;
1257 }
1258
1259 if (unicast)
1260 return netlink_unicast(net->rtnl, skb, portid, MSG_DONTWAIT);
1261
Alexander Aringc35a4ac2018-01-18 11:20:50 -05001262 err = rtnetlink_send(skb, net, portid, RTNLGRP_TC,
1263 n->nlmsg_flags & NLM_F_ECHO);
1264 if (err < 0)
1265 NL_SET_ERR_MSG(extack, "Failed to send filter delete notification");
1266 return err;
WANG Cong71203712017-08-07 15:26:50 -07001267}
1268
1269static void tfilter_notify_chain(struct net *net, struct sk_buff *oskb,
Jiri Pirko7960d1d2018-01-17 11:46:51 +01001270 struct tcf_block *block, struct Qdisc *q,
1271 u32 parent, struct nlmsghdr *n,
WANG Cong71203712017-08-07 15:26:50 -07001272 struct tcf_chain *chain, int event)
1273{
1274 struct tcf_proto *tp;
1275
1276 for (tp = rtnl_dereference(chain->filter_chain);
1277 tp; tp = rtnl_dereference(tp->next))
Jiri Pirko7960d1d2018-01-17 11:46:51 +01001278 tfilter_notify(net, oskb, n, tp, block,
YueHaibing53189182018-07-17 20:58:14 +08001279 q, parent, NULL, event, false);
WANG Cong71203712017-08-07 15:26:50 -07001280}
1281
Vlad Buslovc431f892018-05-31 09:52:53 +03001282static int tc_new_tfilter(struct sk_buff *skb, struct nlmsghdr *n,
David Ahernc21ef3e2017-04-16 09:48:24 -07001283 struct netlink_ext_ack *extack)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001284{
YOSHIFUJI Hideaki3b1e0a62008-03-26 02:26:21 +09001285 struct net *net = sock_net(skb->sk);
Patrick McHardyadd93b62008-01-22 22:11:33 -08001286 struct nlattr *tca[TCA_MAX + 1];
Linus Torvalds1da177e2005-04-16 15:20:36 -07001287 struct tcmsg *t;
1288 u32 protocol;
1289 u32 prio;
Jiri Pirko9d36d9e2017-05-17 11:07:57 +02001290 bool prio_allocate;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001291 u32 parent;
Jiri Pirko5bc17012017-05-17 11:08:01 +02001292 u32 chain_index;
Jiri Pirko7960d1d2018-01-17 11:46:51 +01001293 struct Qdisc *q = NULL;
Jiri Pirko2190d1d2017-05-17 11:07:59 +02001294 struct tcf_chain_info chain_info;
Jiri Pirko5bc17012017-05-17 11:08:01 +02001295 struct tcf_chain *chain = NULL;
Jiri Pirko6529eab2017-05-17 11:07:55 +02001296 struct tcf_block *block;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001297 struct tcf_proto *tp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001298 unsigned long cl;
WANG Cong8113c092017-08-04 21:31:43 -07001299 void *fh;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001300 int err;
Daniel Borkmann628185c2016-12-21 18:04:11 +01001301 int tp_created;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001302
Vlad Buslovc431f892018-05-31 09:52:53 +03001303 if (!netlink_ns_capable(skb, net->user_ns, CAP_NET_ADMIN))
Eric W. Biedermandfc47ef2012-11-16 03:03:00 +00001304 return -EPERM;
Hong zhi guode179c82013-03-25 17:36:33 +00001305
Linus Torvalds1da177e2005-04-16 15:20:36 -07001306replay:
Daniel Borkmann628185c2016-12-21 18:04:11 +01001307 tp_created = 0;
1308
Davide Carattie3314732018-10-10 22:00:58 +02001309 err = nlmsg_parse(n, sizeof(*t), tca, TCA_MAX, rtm_tca_policy, extack);
Hong zhi guode179c82013-03-25 17:36:33 +00001310 if (err < 0)
1311 return err;
1312
David S. Miller942b8162012-06-26 21:48:50 -07001313 t = nlmsg_data(n);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001314 protocol = TC_H_MIN(t->tcm_info);
1315 prio = TC_H_MAJ(t->tcm_info);
Jiri Pirko9d36d9e2017-05-17 11:07:57 +02001316 prio_allocate = false;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001317 parent = t->tcm_parent;
1318 cl = 0;
1319
1320 if (prio == 0) {
Vlad Buslovc431f892018-05-31 09:52:53 +03001321 /* If no priority is provided by the user,
1322 * we allocate one.
1323 */
1324 if (n->nlmsg_flags & NLM_F_CREATE) {
1325 prio = TC_H_MAKE(0x80000000U, 0U);
1326 prio_allocate = true;
1327 } else {
Alexander Aringc35a4ac2018-01-18 11:20:50 -05001328 NL_SET_ERR_MSG(extack, "Invalid filter command with priority of zero");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001329 return -ENOENT;
Daniel Borkmannea7f8272016-06-10 23:10:22 +02001330 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001331 }
1332
1333 /* Find head of filter chain. */
1334
Vlad Buslovc431f892018-05-31 09:52:53 +03001335 block = tcf_block_find(net, &q, &parent, &cl,
1336 t->tcm_ifindex, t->tcm_block_index, extack);
1337 if (IS_ERR(block)) {
1338 err = PTR_ERR(block);
1339 goto errout;
Jiri Pirko6bb16e72017-02-09 14:38:58 +01001340 }
Jiri Pirko5bc17012017-05-17 11:08:01 +02001341
1342 chain_index = tca[TCA_CHAIN] ? nla_get_u32(tca[TCA_CHAIN]) : 0;
1343 if (chain_index > TC_ACT_EXT_VAL_MASK) {
Alexander Aringc35a4ac2018-01-18 11:20:50 -05001344 NL_SET_ERR_MSG(extack, "Specified chain index exceeds upper limit");
Jiri Pirko5bc17012017-05-17 11:08:01 +02001345 err = -EINVAL;
1346 goto errout;
1347 }
Vlad Buslovc431f892018-05-31 09:52:53 +03001348 chain = tcf_chain_get(block, chain_index, true);
Jiri Pirko5bc17012017-05-17 11:08:01 +02001349 if (!chain) {
Jiri Pirkod5ed72a2018-08-27 20:58:43 +02001350 NL_SET_ERR_MSG(extack, "Cannot create specified filter chain");
Vlad Buslovc431f892018-05-31 09:52:53 +03001351 err = -ENOMEM;
Daniel Borkmannea7f8272016-06-10 23:10:22 +02001352 goto errout;
1353 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001354
Jiri Pirko2190d1d2017-05-17 11:07:59 +02001355 tp = tcf_chain_tp_find(chain, &chain_info, protocol,
1356 prio, prio_allocate);
1357 if (IS_ERR(tp)) {
Alexander Aringc35a4ac2018-01-18 11:20:50 -05001358 NL_SET_ERR_MSG(extack, "Filter with specified priority/protocol not found");
Jiri Pirko2190d1d2017-05-17 11:07:59 +02001359 err = PTR_ERR(tp);
1360 goto errout;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001361 }
1362
1363 if (tp == NULL) {
1364 /* Proto-tcf does not exist, create new one */
1365
Jiri Pirko6bb16e72017-02-09 14:38:58 +01001366 if (tca[TCA_KIND] == NULL || !protocol) {
Alexander Aringc35a4ac2018-01-18 11:20:50 -05001367 NL_SET_ERR_MSG(extack, "Filter kind and protocol must be specified");
Jiri Pirko6bb16e72017-02-09 14:38:58 +01001368 err = -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001369 goto errout;
Jiri Pirko6bb16e72017-02-09 14:38:58 +01001370 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001371
Vlad Buslovc431f892018-05-31 09:52:53 +03001372 if (!(n->nlmsg_flags & NLM_F_CREATE)) {
Alexander Aringc35a4ac2018-01-18 11:20:50 -05001373 NL_SET_ERR_MSG(extack, "Need both RTM_NEWTFILTER and NLM_F_CREATE to create a new filter");
Jiri Pirko6bb16e72017-02-09 14:38:58 +01001374 err = -ENOENT;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001375 goto errout;
Jiri Pirko6bb16e72017-02-09 14:38:58 +01001376 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001377
Jiri Pirko9d36d9e2017-05-17 11:07:57 +02001378 if (prio_allocate)
Jiri Pirko2190d1d2017-05-17 11:07:59 +02001379 prio = tcf_auto_prio(tcf_chain_tp_prev(&chain_info));
Linus Torvalds1da177e2005-04-16 15:20:36 -07001380
Jiri Pirko33a48922017-02-09 14:38:57 +01001381 tp = tcf_proto_create(nla_data(tca[TCA_KIND]),
Alexander Aringc35a4ac2018-01-18 11:20:50 -05001382 protocol, prio, chain, extack);
Jiri Pirko33a48922017-02-09 14:38:57 +01001383 if (IS_ERR(tp)) {
1384 err = PTR_ERR(tp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001385 goto errout;
1386 }
Minoru Usui12186be2009-06-02 02:17:34 -07001387 tp_created = 1;
Jiri Pirko6bb16e72017-02-09 14:38:58 +01001388 } else if (tca[TCA_KIND] && nla_strcmp(tca[TCA_KIND], tp->ops->kind)) {
Alexander Aringc35a4ac2018-01-18 11:20:50 -05001389 NL_SET_ERR_MSG(extack, "Specified filter kind does not match existing one");
Jiri Pirko6bb16e72017-02-09 14:38:58 +01001390 err = -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001391 goto errout;
Jiri Pirko6bb16e72017-02-09 14:38:58 +01001392 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001393
1394 fh = tp->ops->get(tp, t->tcm_handle);
1395
WANG Cong8113c092017-08-04 21:31:43 -07001396 if (!fh) {
Vlad Buslovc431f892018-05-31 09:52:53 +03001397 if (!(n->nlmsg_flags & NLM_F_CREATE)) {
Alexander Aringc35a4ac2018-01-18 11:20:50 -05001398 NL_SET_ERR_MSG(extack, "Need both RTM_NEWTFILTER and NLM_F_CREATE to create a new filter");
Jiri Pirko6bb16e72017-02-09 14:38:58 +01001399 err = -ENOENT;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001400 goto errout;
Jiri Pirko6bb16e72017-02-09 14:38:58 +01001401 }
Vlad Buslovc431f892018-05-31 09:52:53 +03001402 } else if (n->nlmsg_flags & NLM_F_EXCL) {
1403 NL_SET_ERR_MSG(extack, "Filter already exists");
1404 err = -EEXIST;
1405 goto errout;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001406 }
1407
Jiri Pirko9f407f12018-07-23 09:23:07 +02001408 if (chain->tmplt_ops && chain->tmplt_ops != tp->ops) {
1409 NL_SET_ERR_MSG(extack, "Chain template is set to a different filter kind");
1410 err = -EINVAL;
1411 goto errout;
1412 }
1413
Cong Wang2f7ef2f2014-04-25 13:54:06 -07001414 err = tp->ops->change(net, skb, tp, cl, t->tcm_handle, tca, &fh,
Alexander Aring7306db32018-01-18 11:20:51 -05001415 n->nlmsg_flags & NLM_F_CREATE ? TCA_ACT_NOREPLACE : TCA_ACT_REPLACE,
1416 extack);
Minoru Usui12186be2009-06-02 02:17:34 -07001417 if (err == 0) {
Jiri Pirko2190d1d2017-05-17 11:07:59 +02001418 if (tp_created)
1419 tcf_chain_tp_insert(chain, &chain_info, tp);
Jiri Pirko7960d1d2018-01-17 11:46:51 +01001420 tfilter_notify(net, skb, n, tp, block, q, parent, fh,
Jiri Pirkoa10fa202017-10-13 14:01:05 +02001421 RTM_NEWTFILTER, false);
Minoru Usui12186be2009-06-02 02:17:34 -07001422 } else {
1423 if (tp_created)
Jakub Kicinski715df5e2018-01-24 12:54:13 -08001424 tcf_proto_destroy(tp, NULL);
Minoru Usui12186be2009-06-02 02:17:34 -07001425 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001426
1427errout:
Jiri Pirko5bc17012017-05-17 11:08:01 +02001428 if (chain)
1429 tcf_chain_put(chain);
Vlad Buslove368fdb2018-09-24 19:22:53 +03001430 tcf_block_release(q, block);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001431 if (err == -EAGAIN)
1432 /* Replay the request. */
1433 goto replay;
1434 return err;
1435}
1436
Vlad Buslovc431f892018-05-31 09:52:53 +03001437static int tc_del_tfilter(struct sk_buff *skb, struct nlmsghdr *n,
1438 struct netlink_ext_ack *extack)
1439{
1440 struct net *net = sock_net(skb->sk);
1441 struct nlattr *tca[TCA_MAX + 1];
1442 struct tcmsg *t;
1443 u32 protocol;
1444 u32 prio;
1445 u32 parent;
1446 u32 chain_index;
1447 struct Qdisc *q = NULL;
1448 struct tcf_chain_info chain_info;
1449 struct tcf_chain *chain = NULL;
1450 struct tcf_block *block;
1451 struct tcf_proto *tp = NULL;
1452 unsigned long cl = 0;
1453 void *fh = NULL;
1454 int err;
1455
1456 if (!netlink_ns_capable(skb, net->user_ns, CAP_NET_ADMIN))
1457 return -EPERM;
1458
Davide Carattie3314732018-10-10 22:00:58 +02001459 err = nlmsg_parse(n, sizeof(*t), tca, TCA_MAX, rtm_tca_policy, extack);
Vlad Buslovc431f892018-05-31 09:52:53 +03001460 if (err < 0)
1461 return err;
1462
1463 t = nlmsg_data(n);
1464 protocol = TC_H_MIN(t->tcm_info);
1465 prio = TC_H_MAJ(t->tcm_info);
1466 parent = t->tcm_parent;
1467
1468 if (prio == 0 && (protocol || t->tcm_handle || tca[TCA_KIND])) {
1469 NL_SET_ERR_MSG(extack, "Cannot flush filters with protocol, handle or kind set");
1470 return -ENOENT;
1471 }
1472
1473 /* Find head of filter chain. */
1474
1475 block = tcf_block_find(net, &q, &parent, &cl,
1476 t->tcm_ifindex, t->tcm_block_index, extack);
1477 if (IS_ERR(block)) {
1478 err = PTR_ERR(block);
1479 goto errout;
1480 }
1481
1482 chain_index = tca[TCA_CHAIN] ? nla_get_u32(tca[TCA_CHAIN]) : 0;
1483 if (chain_index > TC_ACT_EXT_VAL_MASK) {
1484 NL_SET_ERR_MSG(extack, "Specified chain index exceeds upper limit");
1485 err = -EINVAL;
1486 goto errout;
1487 }
1488 chain = tcf_chain_get(block, chain_index, false);
1489 if (!chain) {
Jiri Pirko5ca8a252018-08-03 11:08:47 +02001490 /* User requested flush on non-existent chain. Nothing to do,
1491 * so just return success.
1492 */
1493 if (prio == 0) {
1494 err = 0;
1495 goto errout;
1496 }
Vlad Buslovc431f892018-05-31 09:52:53 +03001497 NL_SET_ERR_MSG(extack, "Cannot find specified filter chain");
Jiri Pirkob7b42472018-08-27 20:58:44 +02001498 err = -ENOENT;
Vlad Buslovc431f892018-05-31 09:52:53 +03001499 goto errout;
1500 }
1501
1502 if (prio == 0) {
1503 tfilter_notify_chain(net, skb, block, q, parent, n,
1504 chain, RTM_DELTFILTER);
1505 tcf_chain_flush(chain);
1506 err = 0;
1507 goto errout;
1508 }
1509
1510 tp = tcf_chain_tp_find(chain, &chain_info, protocol,
1511 prio, false);
1512 if (!tp || IS_ERR(tp)) {
1513 NL_SET_ERR_MSG(extack, "Filter with specified priority/protocol not found");
Vlad Buslov0e399032018-06-04 18:32:23 +03001514 err = tp ? PTR_ERR(tp) : -ENOENT;
Vlad Buslovc431f892018-05-31 09:52:53 +03001515 goto errout;
1516 } else if (tca[TCA_KIND] && nla_strcmp(tca[TCA_KIND], tp->ops->kind)) {
1517 NL_SET_ERR_MSG(extack, "Specified filter kind does not match existing one");
1518 err = -EINVAL;
1519 goto errout;
1520 }
1521
1522 fh = tp->ops->get(tp, t->tcm_handle);
1523
1524 if (!fh) {
1525 if (t->tcm_handle == 0) {
1526 tcf_chain_tp_remove(chain, &chain_info, tp);
1527 tfilter_notify(net, skb, n, tp, block, q, parent, fh,
1528 RTM_DELTFILTER, false);
1529 tcf_proto_destroy(tp, extack);
1530 err = 0;
1531 } else {
1532 NL_SET_ERR_MSG(extack, "Specified filter handle not found");
1533 err = -ENOENT;
1534 }
1535 } else {
1536 bool last;
1537
1538 err = tfilter_del_notify(net, skb, n, tp, block,
1539 q, parent, fh, false, &last,
1540 extack);
1541 if (err)
1542 goto errout;
1543 if (last) {
1544 tcf_chain_tp_remove(chain, &chain_info, tp);
1545 tcf_proto_destroy(tp, extack);
1546 }
1547 }
1548
1549errout:
1550 if (chain)
1551 tcf_chain_put(chain);
Vlad Buslove368fdb2018-09-24 19:22:53 +03001552 tcf_block_release(q, block);
Vlad Buslovc431f892018-05-31 09:52:53 +03001553 return err;
1554}
1555
1556static int tc_get_tfilter(struct sk_buff *skb, struct nlmsghdr *n,
1557 struct netlink_ext_ack *extack)
1558{
1559 struct net *net = sock_net(skb->sk);
1560 struct nlattr *tca[TCA_MAX + 1];
1561 struct tcmsg *t;
1562 u32 protocol;
1563 u32 prio;
1564 u32 parent;
1565 u32 chain_index;
1566 struct Qdisc *q = NULL;
1567 struct tcf_chain_info chain_info;
1568 struct tcf_chain *chain = NULL;
1569 struct tcf_block *block;
1570 struct tcf_proto *tp = NULL;
1571 unsigned long cl = 0;
1572 void *fh = NULL;
1573 int err;
1574
Davide Carattie3314732018-10-10 22:00:58 +02001575 err = nlmsg_parse(n, sizeof(*t), tca, TCA_MAX, rtm_tca_policy, extack);
Vlad Buslovc431f892018-05-31 09:52:53 +03001576 if (err < 0)
1577 return err;
1578
1579 t = nlmsg_data(n);
1580 protocol = TC_H_MIN(t->tcm_info);
1581 prio = TC_H_MAJ(t->tcm_info);
1582 parent = t->tcm_parent;
1583
1584 if (prio == 0) {
1585 NL_SET_ERR_MSG(extack, "Invalid filter command with priority of zero");
1586 return -ENOENT;
1587 }
1588
1589 /* Find head of filter chain. */
1590
1591 block = tcf_block_find(net, &q, &parent, &cl,
1592 t->tcm_ifindex, t->tcm_block_index, extack);
1593 if (IS_ERR(block)) {
1594 err = PTR_ERR(block);
1595 goto errout;
1596 }
1597
1598 chain_index = tca[TCA_CHAIN] ? nla_get_u32(tca[TCA_CHAIN]) : 0;
1599 if (chain_index > TC_ACT_EXT_VAL_MASK) {
1600 NL_SET_ERR_MSG(extack, "Specified chain index exceeds upper limit");
1601 err = -EINVAL;
1602 goto errout;
1603 }
1604 chain = tcf_chain_get(block, chain_index, false);
1605 if (!chain) {
1606 NL_SET_ERR_MSG(extack, "Cannot find specified filter chain");
1607 err = -EINVAL;
1608 goto errout;
1609 }
1610
1611 tp = tcf_chain_tp_find(chain, &chain_info, protocol,
1612 prio, false);
1613 if (!tp || IS_ERR(tp)) {
1614 NL_SET_ERR_MSG(extack, "Filter with specified priority/protocol not found");
Vlad Buslov0e399032018-06-04 18:32:23 +03001615 err = tp ? PTR_ERR(tp) : -ENOENT;
Vlad Buslovc431f892018-05-31 09:52:53 +03001616 goto errout;
1617 } else if (tca[TCA_KIND] && nla_strcmp(tca[TCA_KIND], tp->ops->kind)) {
1618 NL_SET_ERR_MSG(extack, "Specified filter kind does not match existing one");
1619 err = -EINVAL;
1620 goto errout;
1621 }
1622
1623 fh = tp->ops->get(tp, t->tcm_handle);
1624
1625 if (!fh) {
1626 NL_SET_ERR_MSG(extack, "Specified filter handle not found");
1627 err = -ENOENT;
1628 } else {
1629 err = tfilter_notify(net, skb, n, tp, block, q, parent,
1630 fh, RTM_NEWTFILTER, true);
1631 if (err < 0)
1632 NL_SET_ERR_MSG(extack, "Failed to send filter notify message");
1633 }
1634
1635errout:
1636 if (chain)
1637 tcf_chain_put(chain);
Vlad Buslove368fdb2018-09-24 19:22:53 +03001638 tcf_block_release(q, block);
Vlad Buslovc431f892018-05-31 09:52:53 +03001639 return err;
1640}
1641
Stephen Hemmingeraa767bf2008-01-21 02:26:41 -08001642struct tcf_dump_args {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001643 struct tcf_walker w;
1644 struct sk_buff *skb;
1645 struct netlink_callback *cb;
Jiri Pirko7960d1d2018-01-17 11:46:51 +01001646 struct tcf_block *block;
Jiri Pirkoa10fa202017-10-13 14:01:05 +02001647 struct Qdisc *q;
1648 u32 parent;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001649};
1650
WANG Cong8113c092017-08-04 21:31:43 -07001651static int tcf_node_dump(struct tcf_proto *tp, void *n, struct tcf_walker *arg)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001652{
Stephen Hemmingeraa767bf2008-01-21 02:26:41 -08001653 struct tcf_dump_args *a = (void *)arg;
WANG Cong832d1d52014-01-09 16:14:01 -08001654 struct net *net = sock_net(a->skb->sk);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001655
Jiri Pirko7960d1d2018-01-17 11:46:51 +01001656 return tcf_fill_node(net, a->skb, tp, a->block, a->q, a->parent,
Jiri Pirkoa10fa202017-10-13 14:01:05 +02001657 n, NETLINK_CB(a->cb->skb).portid,
Jamal Hadi Salim5a7a5552016-09-18 08:45:33 -04001658 a->cb->nlh->nlmsg_seq, NLM_F_MULTI,
1659 RTM_NEWTFILTER);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001660}
1661
Jiri Pirkoa10fa202017-10-13 14:01:05 +02001662static bool tcf_chain_dump(struct tcf_chain *chain, struct Qdisc *q, u32 parent,
1663 struct sk_buff *skb, struct netlink_callback *cb,
Jiri Pirkoacb31fa2017-05-17 11:08:00 +02001664 long index_start, long *p_index)
1665{
1666 struct net *net = sock_net(skb->sk);
Jiri Pirko7960d1d2018-01-17 11:46:51 +01001667 struct tcf_block *block = chain->block;
Jiri Pirkoacb31fa2017-05-17 11:08:00 +02001668 struct tcmsg *tcm = nlmsg_data(cb->nlh);
1669 struct tcf_dump_args arg;
1670 struct tcf_proto *tp;
1671
1672 for (tp = rtnl_dereference(chain->filter_chain);
1673 tp; tp = rtnl_dereference(tp->next), (*p_index)++) {
1674 if (*p_index < index_start)
1675 continue;
1676 if (TC_H_MAJ(tcm->tcm_info) &&
1677 TC_H_MAJ(tcm->tcm_info) != tp->prio)
1678 continue;
1679 if (TC_H_MIN(tcm->tcm_info) &&
1680 TC_H_MIN(tcm->tcm_info) != tp->protocol)
1681 continue;
1682 if (*p_index > index_start)
1683 memset(&cb->args[1], 0,
1684 sizeof(cb->args) - sizeof(cb->args[0]));
1685 if (cb->args[1] == 0) {
YueHaibing53189182018-07-17 20:58:14 +08001686 if (tcf_fill_node(net, skb, tp, block, q, parent, NULL,
Jiri Pirkoacb31fa2017-05-17 11:08:00 +02001687 NETLINK_CB(cb->skb).portid,
1688 cb->nlh->nlmsg_seq, NLM_F_MULTI,
1689 RTM_NEWTFILTER) <= 0)
Jiri Pirko5bc17012017-05-17 11:08:01 +02001690 return false;
Jiri Pirkoacb31fa2017-05-17 11:08:00 +02001691
1692 cb->args[1] = 1;
1693 }
1694 if (!tp->ops->walk)
1695 continue;
1696 arg.w.fn = tcf_node_dump;
1697 arg.skb = skb;
1698 arg.cb = cb;
Jiri Pirko7960d1d2018-01-17 11:46:51 +01001699 arg.block = block;
Jiri Pirkoa10fa202017-10-13 14:01:05 +02001700 arg.q = q;
1701 arg.parent = parent;
Jiri Pirkoacb31fa2017-05-17 11:08:00 +02001702 arg.w.stop = 0;
1703 arg.w.skip = cb->args[1] - 1;
1704 arg.w.count = 0;
Vlad Buslov01683a12018-07-09 13:29:11 +03001705 arg.w.cookie = cb->args[2];
Jiri Pirkoacb31fa2017-05-17 11:08:00 +02001706 tp->ops->walk(tp, &arg.w);
Vlad Buslov01683a12018-07-09 13:29:11 +03001707 cb->args[2] = arg.w.cookie;
Jiri Pirkoacb31fa2017-05-17 11:08:00 +02001708 cb->args[1] = arg.w.count + 1;
1709 if (arg.w.stop)
Jiri Pirko5bc17012017-05-17 11:08:01 +02001710 return false;
Jiri Pirkoacb31fa2017-05-17 11:08:00 +02001711 }
Jiri Pirko5bc17012017-05-17 11:08:01 +02001712 return true;
Jiri Pirkoacb31fa2017-05-17 11:08:00 +02001713}
1714
Eric Dumazetbd27a872009-11-05 20:57:26 -08001715/* called with RTNL */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001716static int tc_dump_tfilter(struct sk_buff *skb, struct netlink_callback *cb)
1717{
YOSHIFUJI Hideaki3b1e0a62008-03-26 02:26:21 +09001718 struct net *net = sock_net(skb->sk);
Jiri Pirko5bc17012017-05-17 11:08:01 +02001719 struct nlattr *tca[TCA_MAX + 1];
Jiri Pirko7960d1d2018-01-17 11:46:51 +01001720 struct Qdisc *q = NULL;
Jiri Pirko6529eab2017-05-17 11:07:55 +02001721 struct tcf_block *block;
Jiri Pirko2190d1d2017-05-17 11:07:59 +02001722 struct tcf_chain *chain;
David S. Miller942b8162012-06-26 21:48:50 -07001723 struct tcmsg *tcm = nlmsg_data(cb->nlh);
Jiri Pirkoacb31fa2017-05-17 11:08:00 +02001724 long index_start;
1725 long index;
Jiri Pirkoa10fa202017-10-13 14:01:05 +02001726 u32 parent;
Jiri Pirko5bc17012017-05-17 11:08:01 +02001727 int err;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001728
Hong zhi guo573ce262013-03-27 06:47:04 +00001729 if (nlmsg_len(cb->nlh) < sizeof(*tcm))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001730 return skb->len;
Jiri Pirko5bc17012017-05-17 11:08:01 +02001731
David Aherndac9c972018-10-07 20:16:24 -07001732 err = nlmsg_parse(cb->nlh, sizeof(*tcm), tca, TCA_MAX, NULL,
1733 cb->extack);
Jiri Pirko5bc17012017-05-17 11:08:01 +02001734 if (err)
1735 return err;
1736
Jiri Pirko7960d1d2018-01-17 11:46:51 +01001737 if (tcm->tcm_ifindex == TCM_IFINDEX_MAGIC_BLOCK) {
Vlad Buslov787ce6d2018-09-24 19:22:58 +03001738 block = tcf_block_refcnt_get(net, tcm->tcm_block_index);
Jiri Pirko7960d1d2018-01-17 11:46:51 +01001739 if (!block)
WANG Cong143976c2017-08-24 16:51:29 -07001740 goto out;
Jiri Pirkod680b352018-01-18 16:14:49 +01001741 /* If we work with block index, q is NULL and parent value
1742 * will never be used in the following code. The check
1743 * in tcf_fill_node prevents it. However, compiler does not
1744 * see that far, so set parent to zero to silence the warning
1745 * about parent being uninitialized.
1746 */
1747 parent = 0;
Jiri Pirko7960d1d2018-01-17 11:46:51 +01001748 } else {
1749 const struct Qdisc_class_ops *cops;
1750 struct net_device *dev;
1751 unsigned long cl = 0;
1752
1753 dev = __dev_get_by_index(net, tcm->tcm_ifindex);
1754 if (!dev)
1755 return skb->len;
1756
1757 parent = tcm->tcm_parent;
1758 if (!parent) {
1759 q = dev->qdisc;
1760 parent = q->handle;
1761 } else {
1762 q = qdisc_lookup(dev, TC_H_MAJ(tcm->tcm_parent));
1763 }
1764 if (!q)
1765 goto out;
1766 cops = q->ops->cl_ops;
1767 if (!cops)
1768 goto out;
1769 if (!cops->tcf_block)
1770 goto out;
1771 if (TC_H_MIN(tcm->tcm_parent)) {
1772 cl = cops->find(q, tcm->tcm_parent);
1773 if (cl == 0)
1774 goto out;
1775 }
1776 block = cops->tcf_block(q, cl, NULL);
1777 if (!block)
1778 goto out;
1779 if (tcf_block_shared(block))
1780 q = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001781 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001782
Jiri Pirkoacb31fa2017-05-17 11:08:00 +02001783 index_start = cb->args[0];
1784 index = 0;
Jiri Pirko5bc17012017-05-17 11:08:01 +02001785
1786 list_for_each_entry(chain, &block->chain_list, list) {
1787 if (tca[TCA_CHAIN] &&
1788 nla_get_u32(tca[TCA_CHAIN]) != chain->index)
1789 continue;
Jiri Pirkoa10fa202017-10-13 14:01:05 +02001790 if (!tcf_chain_dump(chain, q, parent, skb, cb,
Roman Kapl5ae437a2018-02-19 21:32:51 +01001791 index_start, &index)) {
1792 err = -EMSGSIZE;
Jiri Pirko5bc17012017-05-17 11:08:01 +02001793 break;
Roman Kapl5ae437a2018-02-19 21:32:51 +01001794 }
Jiri Pirko5bc17012017-05-17 11:08:01 +02001795 }
1796
Vlad Buslov787ce6d2018-09-24 19:22:58 +03001797 if (tcm->tcm_ifindex == TCM_IFINDEX_MAGIC_BLOCK)
1798 tcf_block_refcnt_put(block);
Jiri Pirkoacb31fa2017-05-17 11:08:00 +02001799 cb->args[0] = index;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001800
Linus Torvalds1da177e2005-04-16 15:20:36 -07001801out:
Roman Kapl5ae437a2018-02-19 21:32:51 +01001802 /* If we did no progress, the error (EMSGSIZE) is real */
1803 if (skb->len == 0 && err)
1804 return err;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001805 return skb->len;
1806}
1807
Jiri Pirko32a4f5e2018-07-23 09:23:06 +02001808static int tc_chain_fill_node(struct tcf_chain *chain, struct net *net,
1809 struct sk_buff *skb, struct tcf_block *block,
1810 u32 portid, u32 seq, u16 flags, int event)
1811{
1812 unsigned char *b = skb_tail_pointer(skb);
Jiri Pirko9f407f12018-07-23 09:23:07 +02001813 const struct tcf_proto_ops *ops;
Jiri Pirko32a4f5e2018-07-23 09:23:06 +02001814 struct nlmsghdr *nlh;
1815 struct tcmsg *tcm;
Jiri Pirko9f407f12018-07-23 09:23:07 +02001816 void *priv;
1817
1818 ops = chain->tmplt_ops;
1819 priv = chain->tmplt_priv;
Jiri Pirko32a4f5e2018-07-23 09:23:06 +02001820
1821 nlh = nlmsg_put(skb, portid, seq, event, sizeof(*tcm), flags);
1822 if (!nlh)
1823 goto out_nlmsg_trim;
1824 tcm = nlmsg_data(nlh);
1825 tcm->tcm_family = AF_UNSPEC;
1826 tcm->tcm__pad1 = 0;
1827 tcm->tcm__pad2 = 0;
1828 tcm->tcm_handle = 0;
1829 if (block->q) {
1830 tcm->tcm_ifindex = qdisc_dev(block->q)->ifindex;
1831 tcm->tcm_parent = block->q->handle;
1832 } else {
1833 tcm->tcm_ifindex = TCM_IFINDEX_MAGIC_BLOCK;
1834 tcm->tcm_block_index = block->index;
1835 }
1836
1837 if (nla_put_u32(skb, TCA_CHAIN, chain->index))
1838 goto nla_put_failure;
1839
Jiri Pirko9f407f12018-07-23 09:23:07 +02001840 if (ops) {
1841 if (nla_put_string(skb, TCA_KIND, ops->kind))
1842 goto nla_put_failure;
1843 if (ops->tmplt_dump(skb, net, priv) < 0)
1844 goto nla_put_failure;
1845 }
1846
Jiri Pirko32a4f5e2018-07-23 09:23:06 +02001847 nlh->nlmsg_len = skb_tail_pointer(skb) - b;
1848 return skb->len;
1849
1850out_nlmsg_trim:
1851nla_put_failure:
1852 nlmsg_trim(skb, b);
1853 return -EMSGSIZE;
1854}
1855
1856static int tc_chain_notify(struct tcf_chain *chain, struct sk_buff *oskb,
1857 u32 seq, u16 flags, int event, bool unicast)
1858{
1859 u32 portid = oskb ? NETLINK_CB(oskb).portid : 0;
1860 struct tcf_block *block = chain->block;
1861 struct net *net = block->net;
1862 struct sk_buff *skb;
1863
1864 skb = alloc_skb(NLMSG_GOODSIZE, GFP_KERNEL);
1865 if (!skb)
1866 return -ENOBUFS;
1867
1868 if (tc_chain_fill_node(chain, net, skb, block, portid,
1869 seq, flags, event) <= 0) {
1870 kfree_skb(skb);
1871 return -EINVAL;
1872 }
1873
1874 if (unicast)
1875 return netlink_unicast(net->rtnl, skb, portid, MSG_DONTWAIT);
1876
1877 return rtnetlink_send(skb, net, portid, RTNLGRP_TC, flags & NLM_F_ECHO);
1878}
1879
Jiri Pirko9f407f12018-07-23 09:23:07 +02001880static int tc_chain_tmplt_add(struct tcf_chain *chain, struct net *net,
1881 struct nlattr **tca,
1882 struct netlink_ext_ack *extack)
1883{
1884 const struct tcf_proto_ops *ops;
1885 void *tmplt_priv;
1886
1887 /* If kind is not set, user did not specify template. */
1888 if (!tca[TCA_KIND])
1889 return 0;
1890
1891 ops = tcf_proto_lookup_ops(nla_data(tca[TCA_KIND]), extack);
1892 if (IS_ERR(ops))
1893 return PTR_ERR(ops);
1894 if (!ops->tmplt_create || !ops->tmplt_destroy || !ops->tmplt_dump) {
1895 NL_SET_ERR_MSG(extack, "Chain templates are not supported with specified classifier");
1896 return -EOPNOTSUPP;
1897 }
1898
1899 tmplt_priv = ops->tmplt_create(net, chain, tca, extack);
1900 if (IS_ERR(tmplt_priv)) {
1901 module_put(ops->owner);
1902 return PTR_ERR(tmplt_priv);
1903 }
1904 chain->tmplt_ops = ops;
1905 chain->tmplt_priv = tmplt_priv;
1906 return 0;
1907}
1908
1909static void tc_chain_tmplt_del(struct tcf_chain *chain)
1910{
1911 const struct tcf_proto_ops *ops = chain->tmplt_ops;
1912
1913 /* If template ops are set, no work to do for us. */
1914 if (!ops)
1915 return;
1916
1917 ops->tmplt_destroy(chain->tmplt_priv);
1918 module_put(ops->owner);
1919}
1920
Jiri Pirko32a4f5e2018-07-23 09:23:06 +02001921/* Add/delete/get a chain */
1922
1923static int tc_ctl_chain(struct sk_buff *skb, struct nlmsghdr *n,
1924 struct netlink_ext_ack *extack)
1925{
1926 struct net *net = sock_net(skb->sk);
1927 struct nlattr *tca[TCA_MAX + 1];
1928 struct tcmsg *t;
1929 u32 parent;
1930 u32 chain_index;
1931 struct Qdisc *q = NULL;
1932 struct tcf_chain *chain = NULL;
1933 struct tcf_block *block;
1934 unsigned long cl;
1935 int err;
1936
1937 if (n->nlmsg_type != RTM_GETCHAIN &&
1938 !netlink_ns_capable(skb, net->user_ns, CAP_NET_ADMIN))
1939 return -EPERM;
1940
1941replay:
Davide Carattie3314732018-10-10 22:00:58 +02001942 err = nlmsg_parse(n, sizeof(*t), tca, TCA_MAX, rtm_tca_policy, extack);
Jiri Pirko32a4f5e2018-07-23 09:23:06 +02001943 if (err < 0)
1944 return err;
1945
1946 t = nlmsg_data(n);
1947 parent = t->tcm_parent;
1948 cl = 0;
1949
1950 block = tcf_block_find(net, &q, &parent, &cl,
1951 t->tcm_ifindex, t->tcm_block_index, extack);
1952 if (IS_ERR(block))
1953 return PTR_ERR(block);
1954
1955 chain_index = tca[TCA_CHAIN] ? nla_get_u32(tca[TCA_CHAIN]) : 0;
1956 if (chain_index > TC_ACT_EXT_VAL_MASK) {
1957 NL_SET_ERR_MSG(extack, "Specified chain index exceeds upper limit");
Vlad Buslove368fdb2018-09-24 19:22:53 +03001958 err = -EINVAL;
1959 goto errout_block;
Jiri Pirko32a4f5e2018-07-23 09:23:06 +02001960 }
1961 chain = tcf_chain_lookup(block, chain_index);
1962 if (n->nlmsg_type == RTM_NEWCHAIN) {
1963 if (chain) {
Jiri Pirko3d32f4c2018-08-01 12:36:55 +02001964 if (tcf_chain_held_by_acts_only(chain)) {
Jiri Pirko1f3ed382018-07-27 09:45:05 +02001965 /* The chain exists only because there is
Jiri Pirko3d32f4c2018-08-01 12:36:55 +02001966 * some action referencing it.
Jiri Pirko1f3ed382018-07-27 09:45:05 +02001967 */
1968 tcf_chain_hold(chain);
1969 } else {
1970 NL_SET_ERR_MSG(extack, "Filter chain already exists");
Vlad Buslove368fdb2018-09-24 19:22:53 +03001971 err = -EEXIST;
1972 goto errout_block;
Jiri Pirko1f3ed382018-07-27 09:45:05 +02001973 }
1974 } else {
1975 if (!(n->nlmsg_flags & NLM_F_CREATE)) {
1976 NL_SET_ERR_MSG(extack, "Need both RTM_NEWCHAIN and NLM_F_CREATE to create a new chain");
Vlad Buslove368fdb2018-09-24 19:22:53 +03001977 err = -ENOENT;
1978 goto errout_block;
Jiri Pirko1f3ed382018-07-27 09:45:05 +02001979 }
1980 chain = tcf_chain_create(block, chain_index);
1981 if (!chain) {
1982 NL_SET_ERR_MSG(extack, "Failed to create filter chain");
Vlad Buslove368fdb2018-09-24 19:22:53 +03001983 err = -ENOMEM;
1984 goto errout_block;
Jiri Pirko1f3ed382018-07-27 09:45:05 +02001985 }
Jiri Pirko32a4f5e2018-07-23 09:23:06 +02001986 }
1987 } else {
Jiri Pirko3d32f4c2018-08-01 12:36:55 +02001988 if (!chain || tcf_chain_held_by_acts_only(chain)) {
Jiri Pirko32a4f5e2018-07-23 09:23:06 +02001989 NL_SET_ERR_MSG(extack, "Cannot find specified filter chain");
Vlad Buslove368fdb2018-09-24 19:22:53 +03001990 err = -EINVAL;
1991 goto errout_block;
Jiri Pirko32a4f5e2018-07-23 09:23:06 +02001992 }
1993 tcf_chain_hold(chain);
1994 }
1995
1996 switch (n->nlmsg_type) {
1997 case RTM_NEWCHAIN:
Jiri Pirko9f407f12018-07-23 09:23:07 +02001998 err = tc_chain_tmplt_add(chain, net, tca, extack);
1999 if (err)
2000 goto errout;
Jiri Pirko32a4f5e2018-07-23 09:23:06 +02002001 /* In case the chain was successfully added, take a reference
2002 * to the chain. This ensures that an empty chain
2003 * does not disappear at the end of this function.
2004 */
2005 tcf_chain_hold(chain);
2006 chain->explicitly_created = true;
2007 tc_chain_notify(chain, NULL, 0, NLM_F_CREATE | NLM_F_EXCL,
2008 RTM_NEWCHAIN, false);
2009 break;
2010 case RTM_DELCHAIN:
Cong Wangf5b9bac2018-09-11 14:22:23 -07002011 tfilter_notify_chain(net, skb, block, q, parent, n,
2012 chain, RTM_DELTFILTER);
Jiri Pirko32a4f5e2018-07-23 09:23:06 +02002013 /* Flush the chain first as the user requested chain removal. */
2014 tcf_chain_flush(chain);
2015 /* In case the chain was successfully deleted, put a reference
2016 * to the chain previously taken during addition.
2017 */
2018 tcf_chain_put_explicitly_created(chain);
Jiri Pirkoc921d7d2018-07-26 18:27:58 +02002019 chain->explicitly_created = false;
Jiri Pirko32a4f5e2018-07-23 09:23:06 +02002020 break;
2021 case RTM_GETCHAIN:
Jiri Pirko32a4f5e2018-07-23 09:23:06 +02002022 err = tc_chain_notify(chain, skb, n->nlmsg_seq,
2023 n->nlmsg_seq, n->nlmsg_type, true);
2024 if (err < 0)
2025 NL_SET_ERR_MSG(extack, "Failed to send chain notify message");
2026 break;
2027 default:
2028 err = -EOPNOTSUPP;
2029 NL_SET_ERR_MSG(extack, "Unsupported message type");
2030 goto errout;
2031 }
2032
2033errout:
2034 tcf_chain_put(chain);
Vlad Buslove368fdb2018-09-24 19:22:53 +03002035errout_block:
2036 tcf_block_release(q, block);
Jiri Pirko32a4f5e2018-07-23 09:23:06 +02002037 if (err == -EAGAIN)
2038 /* Replay the request. */
2039 goto replay;
2040 return err;
2041}
2042
2043/* called with RTNL */
2044static int tc_dump_chain(struct sk_buff *skb, struct netlink_callback *cb)
2045{
2046 struct net *net = sock_net(skb->sk);
2047 struct nlattr *tca[TCA_MAX + 1];
2048 struct Qdisc *q = NULL;
2049 struct tcf_block *block;
2050 struct tcf_chain *chain;
2051 struct tcmsg *tcm = nlmsg_data(cb->nlh);
2052 long index_start;
2053 long index;
2054 u32 parent;
2055 int err;
2056
2057 if (nlmsg_len(cb->nlh) < sizeof(*tcm))
2058 return skb->len;
2059
Davide Carattie3314732018-10-10 22:00:58 +02002060 err = nlmsg_parse(cb->nlh, sizeof(*tcm), tca, TCA_MAX, rtm_tca_policy,
David Aherndac9c972018-10-07 20:16:24 -07002061 cb->extack);
Jiri Pirko32a4f5e2018-07-23 09:23:06 +02002062 if (err)
2063 return err;
2064
2065 if (tcm->tcm_ifindex == TCM_IFINDEX_MAGIC_BLOCK) {
Vlad Buslov787ce6d2018-09-24 19:22:58 +03002066 block = tcf_block_refcnt_get(net, tcm->tcm_block_index);
Jiri Pirko32a4f5e2018-07-23 09:23:06 +02002067 if (!block)
2068 goto out;
2069 /* If we work with block index, q is NULL and parent value
2070 * will never be used in the following code. The check
2071 * in tcf_fill_node prevents it. However, compiler does not
2072 * see that far, so set parent to zero to silence the warning
2073 * about parent being uninitialized.
2074 */
2075 parent = 0;
2076 } else {
2077 const struct Qdisc_class_ops *cops;
2078 struct net_device *dev;
2079 unsigned long cl = 0;
2080
2081 dev = __dev_get_by_index(net, tcm->tcm_ifindex);
2082 if (!dev)
2083 return skb->len;
2084
2085 parent = tcm->tcm_parent;
2086 if (!parent) {
2087 q = dev->qdisc;
2088 parent = q->handle;
2089 } else {
2090 q = qdisc_lookup(dev, TC_H_MAJ(tcm->tcm_parent));
2091 }
2092 if (!q)
2093 goto out;
2094 cops = q->ops->cl_ops;
2095 if (!cops)
2096 goto out;
2097 if (!cops->tcf_block)
2098 goto out;
2099 if (TC_H_MIN(tcm->tcm_parent)) {
2100 cl = cops->find(q, tcm->tcm_parent);
2101 if (cl == 0)
2102 goto out;
2103 }
2104 block = cops->tcf_block(q, cl, NULL);
2105 if (!block)
2106 goto out;
2107 if (tcf_block_shared(block))
2108 q = NULL;
2109 }
2110
2111 index_start = cb->args[0];
2112 index = 0;
2113
2114 list_for_each_entry(chain, &block->chain_list, list) {
2115 if ((tca[TCA_CHAIN] &&
2116 nla_get_u32(tca[TCA_CHAIN]) != chain->index))
2117 continue;
2118 if (index < index_start) {
2119 index++;
2120 continue;
2121 }
Jiri Pirko3d32f4c2018-08-01 12:36:55 +02002122 if (tcf_chain_held_by_acts_only(chain))
Jiri Pirko1f3ed382018-07-27 09:45:05 +02002123 continue;
Jiri Pirko32a4f5e2018-07-23 09:23:06 +02002124 err = tc_chain_fill_node(chain, net, skb, block,
2125 NETLINK_CB(cb->skb).portid,
2126 cb->nlh->nlmsg_seq, NLM_F_MULTI,
2127 RTM_NEWCHAIN);
2128 if (err <= 0)
2129 break;
2130 index++;
2131 }
2132
Vlad Buslov787ce6d2018-09-24 19:22:58 +03002133 if (tcm->tcm_ifindex == TCM_IFINDEX_MAGIC_BLOCK)
2134 tcf_block_refcnt_put(block);
Jiri Pirko32a4f5e2018-07-23 09:23:06 +02002135 cb->args[0] = index;
2136
2137out:
2138 /* If we did no progress, the error (EMSGSIZE) is real */
2139 if (skb->len == 0 && err)
2140 return err;
2141 return skb->len;
2142}
2143
WANG Cong18d02642014-09-25 10:26:37 -07002144void tcf_exts_destroy(struct tcf_exts *exts)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002145{
2146#ifdef CONFIG_NET_CLS_ACT
Vlad Buslov90b73b72018-07-05 17:24:33 +03002147 tcf_action_destroy(exts->actions, TCA_ACT_UNBIND);
WANG Cong22dc13c2016-08-13 22:35:00 -07002148 kfree(exts->actions);
2149 exts->nr_actions = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002150#endif
2151}
Stephen Hemmingeraa767bf2008-01-21 02:26:41 -08002152EXPORT_SYMBOL(tcf_exts_destroy);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002153
Benjamin LaHaisec1b52732013-01-14 05:15:39 +00002154int tcf_exts_validate(struct net *net, struct tcf_proto *tp, struct nlattr **tb,
Alexander Aring50a56192018-01-18 11:20:52 -05002155 struct nlattr *rate_tlv, struct tcf_exts *exts, bool ovr,
2156 struct netlink_ext_ack *extack)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002157{
Linus Torvalds1da177e2005-04-16 15:20:36 -07002158#ifdef CONFIG_NET_CLS_ACT
2159 {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002160 struct tc_action *act;
Roman Mashakd04e6992018-03-08 16:59:17 -05002161 size_t attr_size = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002162
WANG Cong5da57f42013-12-15 20:15:07 -08002163 if (exts->police && tb[exts->police]) {
Jiri Pirko9fb9f252017-05-17 11:08:02 +02002164 act = tcf_action_init_1(net, tp, tb[exts->police],
2165 rate_tlv, "police", ovr,
Vlad Buslov789871b2018-07-05 17:24:25 +03002166 TCA_ACT_BIND, true, extack);
Patrick McHardyab27cfb2008-01-23 20:33:13 -08002167 if (IS_ERR(act))
2168 return PTR_ERR(act);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002169
WANG Cong33be6272013-12-15 20:15:05 -08002170 act->type = exts->type = TCA_OLD_COMPAT;
WANG Cong22dc13c2016-08-13 22:35:00 -07002171 exts->actions[0] = act;
2172 exts->nr_actions = 1;
WANG Cong5da57f42013-12-15 20:15:07 -08002173 } else if (exts->action && tb[exts->action]) {
Vlad Buslov90b73b72018-07-05 17:24:33 +03002174 int err;
WANG Cong22dc13c2016-08-13 22:35:00 -07002175
Jiri Pirko9fb9f252017-05-17 11:08:02 +02002176 err = tcf_action_init(net, tp, tb[exts->action],
2177 rate_tlv, NULL, ovr, TCA_ACT_BIND,
Vlad Buslov90b73b72018-07-05 17:24:33 +03002178 exts->actions, &attr_size, true,
Vlad Buslov789871b2018-07-05 17:24:25 +03002179 extack);
Vlad Buslov90b73b72018-07-05 17:24:33 +03002180 if (err < 0)
WANG Cong33be6272013-12-15 20:15:05 -08002181 return err;
Vlad Buslov90b73b72018-07-05 17:24:33 +03002182 exts->nr_actions = err;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002183 }
Cong Wange4b95c42017-11-06 13:47:19 -08002184 exts->net = net;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002185 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002186#else
WANG Cong5da57f42013-12-15 20:15:07 -08002187 if ((exts->action && tb[exts->action]) ||
Alexander Aring50a56192018-01-18 11:20:52 -05002188 (exts->police && tb[exts->police])) {
2189 NL_SET_ERR_MSG(extack, "Classifier actions are not supported per compile options (CONFIG_NET_CLS_ACT)");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002190 return -EOPNOTSUPP;
Alexander Aring50a56192018-01-18 11:20:52 -05002191 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002192#endif
2193
2194 return 0;
2195}
Stephen Hemmingeraa767bf2008-01-21 02:26:41 -08002196EXPORT_SYMBOL(tcf_exts_validate);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002197
Jiri Pirko9b0d4442017-08-04 14:29:15 +02002198void tcf_exts_change(struct tcf_exts *dst, struct tcf_exts *src)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002199{
2200#ifdef CONFIG_NET_CLS_ACT
WANG Cong22dc13c2016-08-13 22:35:00 -07002201 struct tcf_exts old = *dst;
2202
Jiri Pirko9b0d4442017-08-04 14:29:15 +02002203 *dst = *src;
WANG Cong22dc13c2016-08-13 22:35:00 -07002204 tcf_exts_destroy(&old);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002205#endif
2206}
Stephen Hemmingeraa767bf2008-01-21 02:26:41 -08002207EXPORT_SYMBOL(tcf_exts_change);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002208
WANG Cong22dc13c2016-08-13 22:35:00 -07002209#ifdef CONFIG_NET_CLS_ACT
2210static struct tc_action *tcf_exts_first_act(struct tcf_exts *exts)
2211{
2212 if (exts->nr_actions == 0)
2213 return NULL;
2214 else
2215 return exts->actions[0];
2216}
2217#endif
WANG Cong33be6272013-12-15 20:15:05 -08002218
WANG Cong5da57f42013-12-15 20:15:07 -08002219int tcf_exts_dump(struct sk_buff *skb, struct tcf_exts *exts)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002220{
2221#ifdef CONFIG_NET_CLS_ACT
Cong Wang9cc63db2014-07-16 14:25:30 -07002222 struct nlattr *nest;
2223
Jiri Pirko978dfd82017-08-04 14:29:03 +02002224 if (exts->action && tcf_exts_has_actions(exts)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002225 /*
2226 * again for backward compatible mode - we want
2227 * to work with both old and new modes of entering
2228 * tc data even if iproute2 was newer - jhs
2229 */
WANG Cong33be6272013-12-15 20:15:05 -08002230 if (exts->type != TCA_OLD_COMPAT) {
WANG Cong5da57f42013-12-15 20:15:07 -08002231 nest = nla_nest_start(skb, exts->action);
Patrick McHardy4b3550ef2008-01-23 20:34:11 -08002232 if (nest == NULL)
2233 goto nla_put_failure;
WANG Cong22dc13c2016-08-13 22:35:00 -07002234
Vlad Buslov90b73b72018-07-05 17:24:33 +03002235 if (tcf_action_dump(skb, exts->actions, 0, 0) < 0)
Patrick McHardyadd93b62008-01-22 22:11:33 -08002236 goto nla_put_failure;
Patrick McHardy4b3550ef2008-01-23 20:34:11 -08002237 nla_nest_end(skb, nest);
WANG Cong5da57f42013-12-15 20:15:07 -08002238 } else if (exts->police) {
WANG Cong33be6272013-12-15 20:15:05 -08002239 struct tc_action *act = tcf_exts_first_act(exts);
WANG Cong5da57f42013-12-15 20:15:07 -08002240 nest = nla_nest_start(skb, exts->police);
Jamal Hadi Salim63acd682013-12-23 08:02:12 -05002241 if (nest == NULL || !act)
Patrick McHardy4b3550ef2008-01-23 20:34:11 -08002242 goto nla_put_failure;
WANG Cong33be6272013-12-15 20:15:05 -08002243 if (tcf_action_dump_old(skb, act, 0, 0) < 0)
Patrick McHardyadd93b62008-01-22 22:11:33 -08002244 goto nla_put_failure;
Patrick McHardy4b3550ef2008-01-23 20:34:11 -08002245 nla_nest_end(skb, nest);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002246 }
2247 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002248 return 0;
Cong Wang9cc63db2014-07-16 14:25:30 -07002249
2250nla_put_failure:
2251 nla_nest_cancel(skb, nest);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002252 return -1;
Cong Wang9cc63db2014-07-16 14:25:30 -07002253#else
2254 return 0;
2255#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07002256}
Stephen Hemmingeraa767bf2008-01-21 02:26:41 -08002257EXPORT_SYMBOL(tcf_exts_dump);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002258
Stephen Hemmingeraa767bf2008-01-21 02:26:41 -08002259
WANG Cong5da57f42013-12-15 20:15:07 -08002260int tcf_exts_dump_stats(struct sk_buff *skb, struct tcf_exts *exts)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002261{
2262#ifdef CONFIG_NET_CLS_ACT
WANG Cong33be6272013-12-15 20:15:05 -08002263 struct tc_action *a = tcf_exts_first_act(exts);
Ignacy Gawędzkib057df22015-02-03 19:05:18 +01002264 if (a != NULL && tcf_action_copy_stats(skb, a, 1) < 0)
WANG Cong33be6272013-12-15 20:15:05 -08002265 return -1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002266#endif
2267 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002268}
Stephen Hemmingeraa767bf2008-01-21 02:26:41 -08002269EXPORT_SYMBOL(tcf_exts_dump_stats);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002270
Jiri Pirko717503b2017-10-11 09:41:09 +02002271static int tc_exts_setup_cb_egdev_call(struct tcf_exts *exts,
2272 enum tc_setup_type type,
2273 void *type_data, bool err_stop)
Jiri Pirkob3f55bd2017-10-11 09:41:08 +02002274{
2275 int ok_count = 0;
2276#ifdef CONFIG_NET_CLS_ACT
2277 const struct tc_action *a;
2278 struct net_device *dev;
Or Gerlitz9d452ce2017-10-24 08:58:02 +03002279 int i, ret;
Jiri Pirkob3f55bd2017-10-11 09:41:08 +02002280
2281 if (!tcf_exts_has_actions(exts))
2282 return 0;
2283
Or Gerlitz9d452ce2017-10-24 08:58:02 +03002284 for (i = 0; i < exts->nr_actions; i++) {
2285 a = exts->actions[i];
Jiri Pirkob3f55bd2017-10-11 09:41:08 +02002286 if (!a->ops->get_dev)
2287 continue;
2288 dev = a->ops->get_dev(a);
Jiri Pirko7612fb02017-11-01 11:47:40 +01002289 if (!dev)
Jiri Pirkob3f55bd2017-10-11 09:41:08 +02002290 continue;
2291 ret = tc_setup_cb_egdev_call(dev, type, type_data, err_stop);
Vlad Buslov84a75b32018-08-10 20:51:52 +03002292 a->ops->put_dev(dev);
Jiri Pirkob3f55bd2017-10-11 09:41:08 +02002293 if (ret < 0)
2294 return ret;
2295 ok_count += ret;
2296 }
2297#endif
2298 return ok_count;
2299}
Jiri Pirko717503b2017-10-11 09:41:09 +02002300
Jiri Pirko208c0f42017-10-19 15:50:32 +02002301int tc_setup_cb_call(struct tcf_block *block, struct tcf_exts *exts,
2302 enum tc_setup_type type, void *type_data, bool err_stop)
Jiri Pirko717503b2017-10-11 09:41:09 +02002303{
David S. Miller9a99dc12018-06-06 13:55:47 -04002304 int ok_count;
Jiri Pirko208c0f42017-10-19 15:50:32 +02002305 int ret;
2306
David S. Miller9a99dc12018-06-06 13:55:47 -04002307 ret = tcf_block_cb_call(block, type, type_data, err_stop);
2308 if (ret < 0)
2309 return ret;
2310 ok_count = ret;
Jiri Pirko208c0f42017-10-19 15:50:32 +02002311
Or Gerlitzf8f4bef2018-05-23 19:24:48 +03002312 if (!exts || ok_count)
David S. Miller9a99dc12018-06-06 13:55:47 -04002313 return ok_count;
Jiri Pirko208c0f42017-10-19 15:50:32 +02002314 ret = tc_exts_setup_cb_egdev_call(exts, type, type_data, err_stop);
2315 if (ret < 0)
2316 return ret;
2317 ok_count += ret;
2318
2319 return ok_count;
Jiri Pirko717503b2017-10-11 09:41:09 +02002320}
2321EXPORT_SYMBOL(tc_setup_cb_call);
Jiri Pirkob3f55bd2017-10-11 09:41:08 +02002322
Jiri Pirko48617382018-01-17 11:46:46 +01002323static __net_init int tcf_net_init(struct net *net)
2324{
2325 struct tcf_net *tn = net_generic(net, tcf_net_id);
2326
Vlad Buslovab281622018-09-24 19:22:56 +03002327 spin_lock_init(&tn->idr_lock);
Jiri Pirko48617382018-01-17 11:46:46 +01002328 idr_init(&tn->idr);
2329 return 0;
2330}
2331
2332static void __net_exit tcf_net_exit(struct net *net)
2333{
2334 struct tcf_net *tn = net_generic(net, tcf_net_id);
2335
2336 idr_destroy(&tn->idr);
2337}
2338
2339static struct pernet_operations tcf_net_ops = {
2340 .init = tcf_net_init,
2341 .exit = tcf_net_exit,
2342 .id = &tcf_net_id,
2343 .size = sizeof(struct tcf_net),
2344};
2345
Linus Torvalds1da177e2005-04-16 15:20:36 -07002346static int __init tc_filter_init(void)
2347{
Jiri Pirko48617382018-01-17 11:46:46 +01002348 int err;
2349
Cong Wang7aa00452017-10-26 18:24:28 -07002350 tc_filter_wq = alloc_ordered_workqueue("tc_filter_workqueue", 0);
2351 if (!tc_filter_wq)
2352 return -ENOMEM;
2353
Jiri Pirko48617382018-01-17 11:46:46 +01002354 err = register_pernet_subsys(&tcf_net_ops);
2355 if (err)
2356 goto err_register_pernet_subsys;
2357
Vlad Buslovc431f892018-05-31 09:52:53 +03002358 rtnl_register(PF_UNSPEC, RTM_NEWTFILTER, tc_new_tfilter, NULL, 0);
2359 rtnl_register(PF_UNSPEC, RTM_DELTFILTER, tc_del_tfilter, NULL, 0);
2360 rtnl_register(PF_UNSPEC, RTM_GETTFILTER, tc_get_tfilter,
Florian Westphalb97bac62017-08-09 20:41:48 +02002361 tc_dump_tfilter, 0);
Jiri Pirko32a4f5e2018-07-23 09:23:06 +02002362 rtnl_register(PF_UNSPEC, RTM_NEWCHAIN, tc_ctl_chain, NULL, 0);
2363 rtnl_register(PF_UNSPEC, RTM_DELCHAIN, tc_ctl_chain, NULL, 0);
2364 rtnl_register(PF_UNSPEC, RTM_GETCHAIN, tc_ctl_chain,
2365 tc_dump_chain, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002366
Linus Torvalds1da177e2005-04-16 15:20:36 -07002367 return 0;
Jiri Pirko48617382018-01-17 11:46:46 +01002368
2369err_register_pernet_subsys:
2370 destroy_workqueue(tc_filter_wq);
2371 return err;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002372}
2373
2374subsys_initcall(tc_filter_init);