Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
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 | ||
1da177e4 LT |
17 | #include <linux/module.h> |
18 | #include <linux/types.h> | |
19 | #include <linux/kernel.h> | |
1da177e4 | 20 | #include <linux/string.h> |
1da177e4 | 21 | #include <linux/errno.h> |
1da177e4 | 22 | #include <linux/skbuff.h> |
1da177e4 LT |
23 | #include <linux/init.h> |
24 | #include <linux/kmod.h> | |
ab27cfb8 | 25 | #include <linux/err.h> |
5a0e3ad6 | 26 | #include <linux/slab.h> |
b854272b DL |
27 | #include <net/net_namespace.h> |
28 | #include <net/sock.h> | |
dc5fc579 | 29 | #include <net/netlink.h> |
1da177e4 LT |
30 | #include <net/pkt_sched.h> |
31 | #include <net/pkt_cls.h> | |
32 | ||
1da177e4 | 33 | /* The list of all installed classifier types */ |
36272874 | 34 | static LIST_HEAD(tcf_proto_base); |
1da177e4 LT |
35 | |
36 | /* Protects list of registered TC modules. It is pure SMP lock. */ | |
37 | static DEFINE_RWLOCK(cls_mod_lock); | |
38 | ||
39 | /* Find classifier type by string name */ | |
40 | ||
dc7f9f6e | 41 | static const struct tcf_proto_ops *tcf_proto_lookup_ops(struct nlattr *kind) |
1da177e4 | 42 | { |
dcd76081 | 43 | const struct tcf_proto_ops *t, *res = NULL; |
1da177e4 LT |
44 | |
45 | if (kind) { | |
46 | read_lock(&cls_mod_lock); | |
36272874 | 47 | list_for_each_entry(t, &tcf_proto_base, head) { |
add93b61 | 48 | if (nla_strcmp(kind, t->kind) == 0) { |
dcd76081 ED |
49 | if (try_module_get(t->owner)) |
50 | res = t; | |
1da177e4 LT |
51 | break; |
52 | } | |
53 | } | |
54 | read_unlock(&cls_mod_lock); | |
55 | } | |
dcd76081 | 56 | return res; |
1da177e4 LT |
57 | } |
58 | ||
59 | /* Register(unregister) new classifier type */ | |
60 | ||
61 | int register_tcf_proto_ops(struct tcf_proto_ops *ops) | |
62 | { | |
36272874 | 63 | struct tcf_proto_ops *t; |
1da177e4 LT |
64 | int rc = -EEXIST; |
65 | ||
66 | write_lock(&cls_mod_lock); | |
36272874 | 67 | list_for_each_entry(t, &tcf_proto_base, head) |
1da177e4 LT |
68 | if (!strcmp(ops->kind, t->kind)) |
69 | goto out; | |
70 | ||
36272874 | 71 | list_add_tail(&ops->head, &tcf_proto_base); |
1da177e4 LT |
72 | rc = 0; |
73 | out: | |
74 | write_unlock(&cls_mod_lock); | |
75 | return rc; | |
76 | } | |
aa767bfe | 77 | EXPORT_SYMBOL(register_tcf_proto_ops); |
1da177e4 LT |
78 | |
79 | int unregister_tcf_proto_ops(struct tcf_proto_ops *ops) | |
80 | { | |
36272874 | 81 | struct tcf_proto_ops *t; |
1da177e4 LT |
82 | int rc = -ENOENT; |
83 | ||
c78e1746 DB |
84 | /* Wait for outstanding call_rcu()s, if any, from a |
85 | * tcf_proto_ops's destroy() handler. | |
86 | */ | |
87 | rcu_barrier(); | |
88 | ||
1da177e4 | 89 | write_lock(&cls_mod_lock); |
dcd76081 ED |
90 | list_for_each_entry(t, &tcf_proto_base, head) { |
91 | if (t == ops) { | |
92 | list_del(&t->head); | |
93 | rc = 0; | |
1da177e4 | 94 | break; |
dcd76081 ED |
95 | } |
96 | } | |
1da177e4 LT |
97 | write_unlock(&cls_mod_lock); |
98 | return rc; | |
99 | } | |
aa767bfe | 100 | EXPORT_SYMBOL(unregister_tcf_proto_ops); |
1da177e4 | 101 | |
7316ae88 TG |
102 | static int tfilter_notify(struct net *net, struct sk_buff *oskb, |
103 | struct nlmsghdr *n, struct tcf_proto *tp, | |
fa59b27c | 104 | unsigned long fh, int event, bool unicast); |
1da177e4 | 105 | |
ea7f8277 DB |
106 | static void tfilter_notify_chain(struct net *net, struct sk_buff *oskb, |
107 | struct nlmsghdr *n, | |
108 | struct tcf_proto __rcu **chain, int event) | |
109 | { | |
110 | struct tcf_proto __rcu **it_chain; | |
111 | struct tcf_proto *tp; | |
112 | ||
113 | for (it_chain = chain; (tp = rtnl_dereference(*it_chain)) != NULL; | |
114 | it_chain = &tp->next) | |
fa59b27c | 115 | tfilter_notify(net, oskb, n, tp, 0, event, false); |
ea7f8277 | 116 | } |
1da177e4 LT |
117 | |
118 | /* Select new prio value from the range, managed by kernel. */ | |
119 | ||
aa767bfe | 120 | static inline u32 tcf_auto_prio(struct tcf_proto *tp) |
1da177e4 | 121 | { |
aa767bfe | 122 | u32 first = TC_H_MAKE(0xC0000000U, 0U); |
1da177e4 LT |
123 | |
124 | if (tp) | |
cc7ec456 | 125 | first = tp->prio - 1; |
1da177e4 LT |
126 | |
127 | return first; | |
128 | } | |
129 | ||
130 | /* Add/change/delete/get a filter node */ | |
131 | ||
661d2967 | 132 | static int tc_ctl_tfilter(struct sk_buff *skb, struct nlmsghdr *n) |
1da177e4 | 133 | { |
3b1e0a65 | 134 | struct net *net = sock_net(skb->sk); |
add93b61 | 135 | struct nlattr *tca[TCA_MAX + 1]; |
1da177e4 LT |
136 | struct tcmsg *t; |
137 | u32 protocol; | |
138 | u32 prio; | |
139 | u32 nprio; | |
140 | u32 parent; | |
141 | struct net_device *dev; | |
142 | struct Qdisc *q; | |
25d8c0d5 JF |
143 | struct tcf_proto __rcu **back; |
144 | struct tcf_proto __rcu **chain; | |
1da177e4 | 145 | struct tcf_proto *tp; |
dc7f9f6e | 146 | const struct tcf_proto_ops *tp_ops; |
20fea08b | 147 | const struct Qdisc_class_ops *cops; |
1da177e4 LT |
148 | unsigned long cl; |
149 | unsigned long fh; | |
150 | int err; | |
12186be7 | 151 | int tp_created = 0; |
1da177e4 | 152 | |
4e8bbb81 | 153 | if ((n->nlmsg_type != RTM_GETTFILTER) && |
5f013c9b | 154 | !netlink_ns_capable(skb, net->user_ns, CAP_NET_ADMIN)) |
dfc47ef8 | 155 | return -EPERM; |
de179c8c | 156 | |
1da177e4 | 157 | replay: |
de179c8c H |
158 | err = nlmsg_parse(n, sizeof(*t), tca, TCA_MAX, NULL); |
159 | if (err < 0) | |
160 | return err; | |
161 | ||
942b8165 | 162 | t = nlmsg_data(n); |
1da177e4 LT |
163 | protocol = TC_H_MIN(t->tcm_info); |
164 | prio = TC_H_MAJ(t->tcm_info); | |
165 | nprio = prio; | |
166 | parent = t->tcm_parent; | |
167 | cl = 0; | |
168 | ||
169 | if (prio == 0) { | |
ea7f8277 DB |
170 | switch (n->nlmsg_type) { |
171 | case RTM_DELTFILTER: | |
9f6ed032 | 172 | if (protocol || t->tcm_handle || tca[TCA_KIND]) |
ea7f8277 DB |
173 | return -ENOENT; |
174 | break; | |
175 | case RTM_NEWTFILTER: | |
176 | /* If no priority is provided by the user, | |
177 | * we allocate one. | |
178 | */ | |
179 | if (n->nlmsg_flags & NLM_F_CREATE) { | |
180 | prio = TC_H_MAKE(0x80000000U, 0U); | |
181 | break; | |
182 | } | |
183 | /* fall-through */ | |
184 | default: | |
1da177e4 | 185 | return -ENOENT; |
ea7f8277 | 186 | } |
1da177e4 LT |
187 | } |
188 | ||
189 | /* Find head of filter chain. */ | |
190 | ||
191 | /* Find link */ | |
7316ae88 | 192 | dev = __dev_get_by_index(net, t->tcm_ifindex); |
aa767bfe | 193 | if (dev == NULL) |
1da177e4 LT |
194 | return -ENODEV; |
195 | ||
196 | /* Find qdisc */ | |
197 | if (!parent) { | |
af356afa | 198 | q = dev->qdisc; |
1da177e4 | 199 | parent = q->handle; |
aa767bfe SH |
200 | } else { |
201 | q = qdisc_lookup(dev, TC_H_MAJ(t->tcm_parent)); | |
202 | if (q == NULL) | |
203 | return -EINVAL; | |
204 | } | |
1da177e4 LT |
205 | |
206 | /* Is it classful? */ | |
cc7ec456 ED |
207 | cops = q->ops->cl_ops; |
208 | if (!cops) | |
1da177e4 LT |
209 | return -EINVAL; |
210 | ||
71ebe5e9 PM |
211 | if (cops->tcf_chain == NULL) |
212 | return -EOPNOTSUPP; | |
213 | ||
1da177e4 LT |
214 | /* Do we search for filter, attached to class? */ |
215 | if (TC_H_MIN(parent)) { | |
216 | cl = cops->get(q, parent); | |
217 | if (cl == 0) | |
218 | return -ENOENT; | |
219 | } | |
220 | ||
221 | /* And the last stroke */ | |
222 | chain = cops->tcf_chain(q, cl); | |
223 | err = -EINVAL; | |
224 | if (chain == NULL) | |
225 | goto errout; | |
ea7f8277 DB |
226 | if (n->nlmsg_type == RTM_DELTFILTER && prio == 0) { |
227 | tfilter_notify_chain(net, skb, n, chain, RTM_DELTFILTER); | |
228 | tcf_destroy_chain(chain); | |
229 | err = 0; | |
230 | goto errout; | |
231 | } | |
1da177e4 LT |
232 | |
233 | /* Check the chain for existence of proto-tcf with this priority */ | |
25d8c0d5 JF |
234 | for (back = chain; |
235 | (tp = rtnl_dereference(*back)) != NULL; | |
236 | back = &tp->next) { | |
1da177e4 LT |
237 | if (tp->prio >= prio) { |
238 | if (tp->prio == prio) { | |
cc7ec456 ED |
239 | if (!nprio || |
240 | (tp->protocol != protocol && protocol)) | |
1da177e4 LT |
241 | goto errout; |
242 | } else | |
243 | tp = NULL; | |
244 | break; | |
245 | } | |
246 | } | |
247 | ||
248 | if (tp == NULL) { | |
249 | /* Proto-tcf does not exist, create new one */ | |
250 | ||
add93b61 | 251 | if (tca[TCA_KIND] == NULL || !protocol) |
1da177e4 LT |
252 | goto errout; |
253 | ||
254 | err = -ENOENT; | |
cc7ec456 ED |
255 | if (n->nlmsg_type != RTM_NEWTFILTER || |
256 | !(n->nlmsg_flags & NLM_F_CREATE)) | |
1da177e4 LT |
257 | goto errout; |
258 | ||
259 | ||
260 | /* Create new proto tcf */ | |
261 | ||
262 | err = -ENOBUFS; | |
aa767bfe SH |
263 | tp = kzalloc(sizeof(*tp), GFP_KERNEL); |
264 | if (tp == NULL) | |
1da177e4 | 265 | goto errout; |
f2df8249 | 266 | err = -ENOENT; |
add93b61 | 267 | tp_ops = tcf_proto_lookup_ops(tca[TCA_KIND]); |
1da177e4 | 268 | if (tp_ops == NULL) { |
95a5afca | 269 | #ifdef CONFIG_MODULES |
add93b61 | 270 | struct nlattr *kind = tca[TCA_KIND]; |
1da177e4 LT |
271 | char name[IFNAMSIZ]; |
272 | ||
273 | if (kind != NULL && | |
add93b61 | 274 | nla_strlcpy(name, kind, IFNAMSIZ) < IFNAMSIZ) { |
1da177e4 LT |
275 | rtnl_unlock(); |
276 | request_module("cls_%s", name); | |
277 | rtnl_lock(); | |
278 | tp_ops = tcf_proto_lookup_ops(kind); | |
279 | /* We dropped the RTNL semaphore in order to | |
280 | * perform the module load. So, even if we | |
281 | * succeeded in loading the module we have to | |
282 | * replay the request. We indicate this using | |
283 | * -EAGAIN. | |
284 | */ | |
285 | if (tp_ops != NULL) { | |
286 | module_put(tp_ops->owner); | |
287 | err = -EAGAIN; | |
288 | } | |
289 | } | |
290 | #endif | |
291 | kfree(tp); | |
292 | goto errout; | |
293 | } | |
1da177e4 LT |
294 | tp->ops = tp_ops; |
295 | tp->protocol = protocol; | |
25d8c0d5 JF |
296 | tp->prio = nprio ? : |
297 | TC_H_MAJ(tcf_auto_prio(rtnl_dereference(*back))); | |
1da177e4 LT |
298 | tp->q = q; |
299 | tp->classify = tp_ops->classify; | |
300 | tp->classid = parent; | |
aa767bfe SH |
301 | |
302 | err = tp_ops->init(tp); | |
303 | if (err != 0) { | |
1da177e4 LT |
304 | module_put(tp_ops->owner); |
305 | kfree(tp); | |
306 | goto errout; | |
307 | } | |
308 | ||
12186be7 | 309 | tp_created = 1; |
1da177e4 | 310 | |
add93b61 | 311 | } else if (tca[TCA_KIND] && nla_strcmp(tca[TCA_KIND], tp->ops->kind)) |
1da177e4 LT |
312 | goto errout; |
313 | ||
314 | fh = tp->ops->get(tp, t->tcm_handle); | |
315 | ||
316 | if (fh == 0) { | |
317 | if (n->nlmsg_type == RTM_DELTFILTER && t->tcm_handle == 0) { | |
25d8c0d5 JF |
318 | struct tcf_proto *next = rtnl_dereference(tp->next); |
319 | ||
320 | RCU_INIT_POINTER(*back, next); | |
1da177e4 | 321 | |
fa59b27c ED |
322 | tfilter_notify(net, skb, n, tp, fh, |
323 | RTM_DELTFILTER, false); | |
1e052be6 | 324 | tcf_destroy(tp, true); |
1da177e4 LT |
325 | err = 0; |
326 | goto errout; | |
327 | } | |
328 | ||
329 | err = -ENOENT; | |
aa767bfe SH |
330 | if (n->nlmsg_type != RTM_NEWTFILTER || |
331 | !(n->nlmsg_flags & NLM_F_CREATE)) | |
1da177e4 LT |
332 | goto errout; |
333 | } else { | |
334 | switch (n->nlmsg_type) { | |
10297b99 | 335 | case RTM_NEWTFILTER: |
1da177e4 | 336 | err = -EEXIST; |
12186be7 MU |
337 | if (n->nlmsg_flags & NLM_F_EXCL) { |
338 | if (tp_created) | |
1e052be6 | 339 | tcf_destroy(tp, true); |
1da177e4 | 340 | goto errout; |
12186be7 | 341 | } |
1da177e4 LT |
342 | break; |
343 | case RTM_DELTFILTER: | |
344 | err = tp->ops->delete(tp, fh); | |
1e052be6 | 345 | if (err == 0) { |
d7443185 | 346 | struct tcf_proto *next = rtnl_dereference(tp->next); |
1e052be6 | 347 | |
5a7a5555 | 348 | tfilter_notify(net, skb, n, tp, fh, |
fa59b27c | 349 | RTM_DELTFILTER, false); |
d7443185 | 350 | if (tcf_destroy(tp, false)) |
1e052be6 | 351 | RCU_INIT_POINTER(*back, next); |
1e052be6 | 352 | } |
1da177e4 LT |
353 | goto errout; |
354 | case RTM_GETTFILTER: | |
5a7a5555 | 355 | err = tfilter_notify(net, skb, n, tp, fh, |
fa59b27c | 356 | RTM_NEWTFILTER, true); |
1da177e4 LT |
357 | goto errout; |
358 | default: | |
359 | err = -EINVAL; | |
360 | goto errout; | |
361 | } | |
362 | } | |
363 | ||
2f7ef2f8 CW |
364 | err = tp->ops->change(net, skb, tp, cl, t->tcm_handle, tca, &fh, |
365 | n->nlmsg_flags & NLM_F_CREATE ? TCA_ACT_NOREPLACE : TCA_ACT_REPLACE); | |
12186be7 MU |
366 | if (err == 0) { |
367 | if (tp_created) { | |
25d8c0d5 JF |
368 | RCU_INIT_POINTER(tp->next, rtnl_dereference(*back)); |
369 | rcu_assign_pointer(*back, tp); | |
12186be7 | 370 | } |
fa59b27c | 371 | tfilter_notify(net, skb, n, tp, fh, RTM_NEWTFILTER, false); |
12186be7 MU |
372 | } else { |
373 | if (tp_created) | |
1e052be6 | 374 | tcf_destroy(tp, true); |
12186be7 | 375 | } |
1da177e4 LT |
376 | |
377 | errout: | |
378 | if (cl) | |
379 | cops->put(q, cl); | |
380 | if (err == -EAGAIN) | |
381 | /* Replay the request. */ | |
382 | goto replay; | |
383 | return err; | |
384 | } | |
385 | ||
0b0f43fe JHS |
386 | static int tcf_fill_node(struct net *net, struct sk_buff *skb, |
387 | struct tcf_proto *tp, unsigned long fh, u32 portid, | |
388 | u32 seq, u16 flags, int event) | |
1da177e4 LT |
389 | { |
390 | struct tcmsg *tcm; | |
391 | struct nlmsghdr *nlh; | |
27a884dc | 392 | unsigned char *b = skb_tail_pointer(skb); |
1da177e4 | 393 | |
15e47304 | 394 | nlh = nlmsg_put(skb, portid, seq, event, sizeof(*tcm), flags); |
942b8165 DM |
395 | if (!nlh) |
396 | goto out_nlmsg_trim; | |
397 | tcm = nlmsg_data(nlh); | |
1da177e4 | 398 | tcm->tcm_family = AF_UNSPEC; |
9ef1d4c7 | 399 | tcm->tcm__pad1 = 0; |
ad61df91 | 400 | tcm->tcm__pad2 = 0; |
5ce2d488 | 401 | tcm->tcm_ifindex = qdisc_dev(tp->q)->ifindex; |
1da177e4 LT |
402 | tcm->tcm_parent = tp->classid; |
403 | tcm->tcm_info = TC_H_MAKE(tp->prio, tp->protocol); | |
1b34ec43 DM |
404 | if (nla_put_string(skb, TCA_KIND, tp->ops->kind)) |
405 | goto nla_put_failure; | |
1da177e4 LT |
406 | tcm->tcm_handle = fh; |
407 | if (RTM_DELTFILTER != event) { | |
408 | tcm->tcm_handle = 0; | |
832d1d5b | 409 | if (tp->ops->dump && tp->ops->dump(net, tp, fh, skb, tcm) < 0) |
add93b61 | 410 | goto nla_put_failure; |
1da177e4 | 411 | } |
27a884dc | 412 | nlh->nlmsg_len = skb_tail_pointer(skb) - b; |
1da177e4 LT |
413 | return skb->len; |
414 | ||
942b8165 | 415 | out_nlmsg_trim: |
add93b61 | 416 | nla_put_failure: |
dc5fc579 | 417 | nlmsg_trim(skb, b); |
1da177e4 LT |
418 | return -1; |
419 | } | |
420 | ||
7316ae88 TG |
421 | static int tfilter_notify(struct net *net, struct sk_buff *oskb, |
422 | struct nlmsghdr *n, struct tcf_proto *tp, | |
fa59b27c | 423 | unsigned long fh, int event, bool unicast) |
1da177e4 LT |
424 | { |
425 | struct sk_buff *skb; | |
15e47304 | 426 | u32 portid = oskb ? NETLINK_CB(oskb).portid : 0; |
1da177e4 LT |
427 | |
428 | skb = alloc_skb(NLMSG_GOODSIZE, GFP_KERNEL); | |
429 | if (!skb) | |
430 | return -ENOBUFS; | |
431 | ||
832d1d5b | 432 | if (tcf_fill_node(net, skb, tp, fh, portid, n->nlmsg_seq, 0, event) <= 0) { |
1da177e4 LT |
433 | kfree_skb(skb); |
434 | return -EINVAL; | |
435 | } | |
436 | ||
fa59b27c ED |
437 | if (unicast) |
438 | return netlink_unicast(net->rtnl, skb, portid, MSG_DONTWAIT); | |
439 | ||
15e47304 | 440 | return rtnetlink_send(skb, net, portid, RTNLGRP_TC, |
aa767bfe | 441 | n->nlmsg_flags & NLM_F_ECHO); |
1da177e4 LT |
442 | } |
443 | ||
aa767bfe | 444 | struct tcf_dump_args { |
1da177e4 LT |
445 | struct tcf_walker w; |
446 | struct sk_buff *skb; | |
447 | struct netlink_callback *cb; | |
448 | }; | |
449 | ||
aa767bfe SH |
450 | static int tcf_node_dump(struct tcf_proto *tp, unsigned long n, |
451 | struct tcf_walker *arg) | |
1da177e4 | 452 | { |
aa767bfe | 453 | struct tcf_dump_args *a = (void *)arg; |
832d1d5b | 454 | struct net *net = sock_net(a->skb->sk); |
1da177e4 | 455 | |
832d1d5b | 456 | return tcf_fill_node(net, a->skb, tp, n, NETLINK_CB(a->cb->skb).portid, |
5a7a5555 JHS |
457 | a->cb->nlh->nlmsg_seq, NLM_F_MULTI, |
458 | RTM_NEWTFILTER); | |
1da177e4 LT |
459 | } |
460 | ||
bd27a875 | 461 | /* called with RTNL */ |
1da177e4 LT |
462 | static int tc_dump_tfilter(struct sk_buff *skb, struct netlink_callback *cb) |
463 | { | |
3b1e0a65 | 464 | struct net *net = sock_net(skb->sk); |
1da177e4 LT |
465 | int t; |
466 | int s_t; | |
467 | struct net_device *dev; | |
468 | struct Qdisc *q; | |
25d8c0d5 | 469 | struct tcf_proto *tp, __rcu **chain; |
942b8165 | 470 | struct tcmsg *tcm = nlmsg_data(cb->nlh); |
1da177e4 | 471 | unsigned long cl = 0; |
20fea08b | 472 | const struct Qdisc_class_ops *cops; |
1da177e4 LT |
473 | struct tcf_dump_args arg; |
474 | ||
573ce260 | 475 | if (nlmsg_len(cb->nlh) < sizeof(*tcm)) |
1da177e4 | 476 | return skb->len; |
cc7ec456 ED |
477 | dev = __dev_get_by_index(net, tcm->tcm_ifindex); |
478 | if (!dev) | |
1da177e4 LT |
479 | return skb->len; |
480 | ||
1da177e4 | 481 | if (!tcm->tcm_parent) |
af356afa | 482 | q = dev->qdisc; |
1da177e4 LT |
483 | else |
484 | q = qdisc_lookup(dev, TC_H_MAJ(tcm->tcm_parent)); | |
485 | if (!q) | |
486 | goto out; | |
cc7ec456 ED |
487 | cops = q->ops->cl_ops; |
488 | if (!cops) | |
1da177e4 | 489 | goto errout; |
71ebe5e9 PM |
490 | if (cops->tcf_chain == NULL) |
491 | goto errout; | |
1da177e4 LT |
492 | if (TC_H_MIN(tcm->tcm_parent)) { |
493 | cl = cops->get(q, tcm->tcm_parent); | |
494 | if (cl == 0) | |
495 | goto errout; | |
496 | } | |
497 | chain = cops->tcf_chain(q, cl); | |
498 | if (chain == NULL) | |
499 | goto errout; | |
500 | ||
501 | s_t = cb->args[0]; | |
502 | ||
25d8c0d5 JF |
503 | for (tp = rtnl_dereference(*chain), t = 0; |
504 | tp; tp = rtnl_dereference(tp->next), t++) { | |
cc7ec456 ED |
505 | if (t < s_t) |
506 | continue; | |
1da177e4 LT |
507 | if (TC_H_MAJ(tcm->tcm_info) && |
508 | TC_H_MAJ(tcm->tcm_info) != tp->prio) | |
509 | continue; | |
510 | if (TC_H_MIN(tcm->tcm_info) && | |
511 | TC_H_MIN(tcm->tcm_info) != tp->protocol) | |
512 | continue; | |
513 | if (t > s_t) | |
0b0f43fe JHS |
514 | memset(&cb->args[1], 0, |
515 | sizeof(cb->args)-sizeof(cb->args[0])); | |
1da177e4 | 516 | if (cb->args[1] == 0) { |
0b0f43fe JHS |
517 | if (tcf_fill_node(net, skb, tp, 0, |
518 | NETLINK_CB(cb->skb).portid, | |
aa767bfe SH |
519 | cb->nlh->nlmsg_seq, NLM_F_MULTI, |
520 | RTM_NEWTFILTER) <= 0) | |
1da177e4 | 521 | break; |
aa767bfe | 522 | |
1da177e4 LT |
523 | cb->args[1] = 1; |
524 | } | |
525 | if (tp->ops->walk == NULL) | |
526 | continue; | |
527 | arg.w.fn = tcf_node_dump; | |
528 | arg.skb = skb; | |
529 | arg.cb = cb; | |
530 | arg.w.stop = 0; | |
cc7ec456 | 531 | arg.w.skip = cb->args[1] - 1; |
1da177e4 LT |
532 | arg.w.count = 0; |
533 | tp->ops->walk(tp, &arg.w); | |
cc7ec456 | 534 | cb->args[1] = arg.w.count + 1; |
1da177e4 LT |
535 | if (arg.w.stop) |
536 | break; | |
537 | } | |
538 | ||
539 | cb->args[0] = t; | |
540 | ||
541 | errout: | |
542 | if (cl) | |
543 | cops->put(q, cl); | |
544 | out: | |
1da177e4 LT |
545 | return skb->len; |
546 | } | |
547 | ||
18d0264f | 548 | void tcf_exts_destroy(struct tcf_exts *exts) |
1da177e4 LT |
549 | { |
550 | #ifdef CONFIG_NET_CLS_ACT | |
22dc13c8 WC |
551 | LIST_HEAD(actions); |
552 | ||
553 | tcf_exts_to_list(exts, &actions); | |
554 | tcf_action_destroy(&actions, TCA_ACT_UNBIND); | |
555 | kfree(exts->actions); | |
556 | exts->nr_actions = 0; | |
1da177e4 LT |
557 | #endif |
558 | } | |
aa767bfe | 559 | EXPORT_SYMBOL(tcf_exts_destroy); |
1da177e4 | 560 | |
c1b52739 | 561 | int tcf_exts_validate(struct net *net, struct tcf_proto *tp, struct nlattr **tb, |
5a7a5555 | 562 | struct nlattr *rate_tlv, struct tcf_exts *exts, bool ovr) |
1da177e4 | 563 | { |
1da177e4 LT |
564 | #ifdef CONFIG_NET_CLS_ACT |
565 | { | |
1da177e4 LT |
566 | struct tc_action *act; |
567 | ||
5da57f42 WC |
568 | if (exts->police && tb[exts->police]) { |
569 | act = tcf_action_init_1(net, tb[exts->police], rate_tlv, | |
5a7a5555 | 570 | "police", ovr, TCA_ACT_BIND); |
ab27cfb8 PM |
571 | if (IS_ERR(act)) |
572 | return PTR_ERR(act); | |
1da177e4 | 573 | |
33be6271 | 574 | act->type = exts->type = TCA_OLD_COMPAT; |
22dc13c8 WC |
575 | exts->actions[0] = act; |
576 | exts->nr_actions = 1; | |
5da57f42 | 577 | } else if (exts->action && tb[exts->action]) { |
22dc13c8 WC |
578 | LIST_HEAD(actions); |
579 | int err, i = 0; | |
580 | ||
5da57f42 | 581 | err = tcf_action_init(net, tb[exts->action], rate_tlv, |
5a7a5555 JHS |
582 | NULL, ovr, TCA_ACT_BIND, |
583 | &actions); | |
33be6271 WC |
584 | if (err) |
585 | return err; | |
22dc13c8 WC |
586 | list_for_each_entry(act, &actions, list) |
587 | exts->actions[i++] = act; | |
588 | exts->nr_actions = i; | |
1da177e4 LT |
589 | } |
590 | } | |
1da177e4 | 591 | #else |
5da57f42 WC |
592 | if ((exts->action && tb[exts->action]) || |
593 | (exts->police && tb[exts->police])) | |
1da177e4 LT |
594 | return -EOPNOTSUPP; |
595 | #endif | |
596 | ||
597 | return 0; | |
598 | } | |
aa767bfe | 599 | EXPORT_SYMBOL(tcf_exts_validate); |
1da177e4 | 600 | |
aa767bfe SH |
601 | void tcf_exts_change(struct tcf_proto *tp, struct tcf_exts *dst, |
602 | struct tcf_exts *src) | |
1da177e4 LT |
603 | { |
604 | #ifdef CONFIG_NET_CLS_ACT | |
22dc13c8 WC |
605 | struct tcf_exts old = *dst; |
606 | ||
a49eb42a | 607 | tcf_tree_lock(tp); |
22dc13c8 WC |
608 | dst->nr_actions = src->nr_actions; |
609 | dst->actions = src->actions; | |
5301e3e1 | 610 | dst->type = src->type; |
a49eb42a | 611 | tcf_tree_unlock(tp); |
22dc13c8 WC |
612 | |
613 | tcf_exts_destroy(&old); | |
1da177e4 LT |
614 | #endif |
615 | } | |
aa767bfe | 616 | EXPORT_SYMBOL(tcf_exts_change); |
1da177e4 | 617 | |
22dc13c8 WC |
618 | #ifdef CONFIG_NET_CLS_ACT |
619 | static struct tc_action *tcf_exts_first_act(struct tcf_exts *exts) | |
620 | { | |
621 | if (exts->nr_actions == 0) | |
622 | return NULL; | |
623 | else | |
624 | return exts->actions[0]; | |
625 | } | |
626 | #endif | |
33be6271 | 627 | |
5da57f42 | 628 | int tcf_exts_dump(struct sk_buff *skb, struct tcf_exts *exts) |
1da177e4 LT |
629 | { |
630 | #ifdef CONFIG_NET_CLS_ACT | |
9cc63db5 CW |
631 | struct nlattr *nest; |
632 | ||
22dc13c8 | 633 | if (exts->action && exts->nr_actions) { |
1da177e4 LT |
634 | /* |
635 | * again for backward compatible mode - we want | |
636 | * to work with both old and new modes of entering | |
637 | * tc data even if iproute2 was newer - jhs | |
638 | */ | |
33be6271 | 639 | if (exts->type != TCA_OLD_COMPAT) { |
22dc13c8 WC |
640 | LIST_HEAD(actions); |
641 | ||
5da57f42 | 642 | nest = nla_nest_start(skb, exts->action); |
4b3550ef PM |
643 | if (nest == NULL) |
644 | goto nla_put_failure; | |
22dc13c8 WC |
645 | |
646 | tcf_exts_to_list(exts, &actions); | |
647 | if (tcf_action_dump(skb, &actions, 0, 0) < 0) | |
add93b61 | 648 | goto nla_put_failure; |
4b3550ef | 649 | nla_nest_end(skb, nest); |
5da57f42 | 650 | } else if (exts->police) { |
33be6271 | 651 | struct tc_action *act = tcf_exts_first_act(exts); |
5da57f42 | 652 | nest = nla_nest_start(skb, exts->police); |
63acd680 | 653 | if (nest == NULL || !act) |
4b3550ef | 654 | goto nla_put_failure; |
33be6271 | 655 | if (tcf_action_dump_old(skb, act, 0, 0) < 0) |
add93b61 | 656 | goto nla_put_failure; |
4b3550ef | 657 | nla_nest_end(skb, nest); |
1da177e4 LT |
658 | } |
659 | } | |
1da177e4 | 660 | return 0; |
9cc63db5 CW |
661 | |
662 | nla_put_failure: | |
663 | nla_nest_cancel(skb, nest); | |
1da177e4 | 664 | return -1; |
9cc63db5 CW |
665 | #else |
666 | return 0; | |
667 | #endif | |
1da177e4 | 668 | } |
aa767bfe | 669 | EXPORT_SYMBOL(tcf_exts_dump); |
1da177e4 | 670 | |
aa767bfe | 671 | |
5da57f42 | 672 | int tcf_exts_dump_stats(struct sk_buff *skb, struct tcf_exts *exts) |
1da177e4 LT |
673 | { |
674 | #ifdef CONFIG_NET_CLS_ACT | |
33be6271 | 675 | struct tc_action *a = tcf_exts_first_act(exts); |
b057df24 | 676 | if (a != NULL && tcf_action_copy_stats(skb, a, 1) < 0) |
33be6271 | 677 | return -1; |
1da177e4 LT |
678 | #endif |
679 | return 0; | |
1da177e4 | 680 | } |
aa767bfe | 681 | EXPORT_SYMBOL(tcf_exts_dump_stats); |
1da177e4 LT |
682 | |
683 | static int __init tc_filter_init(void) | |
684 | { | |
c7ac8679 GR |
685 | rtnl_register(PF_UNSPEC, RTM_NEWTFILTER, tc_ctl_tfilter, NULL, NULL); |
686 | rtnl_register(PF_UNSPEC, RTM_DELTFILTER, tc_ctl_tfilter, NULL, NULL); | |
82623c0d | 687 | rtnl_register(PF_UNSPEC, RTM_GETTFILTER, tc_ctl_tfilter, |
c7ac8679 | 688 | tc_dump_tfilter, NULL); |
1da177e4 | 689 | |
1da177e4 LT |
690 | return 0; |
691 | } | |
692 | ||
693 | subsys_initcall(tc_filter_init); |