2 * net/sched/cls_api.c Packet classifier API.
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.
9 * Authors: Alexey Kuznetsov, <kuznet@ms2.inr.ac.ru>
13 * Eduardo J. Blanco <ejbs@netlabs.com.uy> :990222: kmod support
17 #include <asm/uaccess.h>
18 #include <asm/system.h>
19 #include <linux/bitops.h>
20 #include <linux/module.h>
21 #include <linux/types.h>
22 #include <linux/kernel.h>
23 #include <linux/sched.h>
24 #include <linux/string.h>
26 #include <linux/socket.h>
27 #include <linux/sockios.h>
29 #include <linux/errno.h>
30 #include <linux/interrupt.h>
31 #include <linux/netdevice.h>
32 #include <linux/skbuff.h>
33 #include <linux/rtnetlink.h>
34 #include <linux/init.h>
35 #include <linux/kmod.h>
37 #include <net/pkt_sched.h>
38 #include <net/pkt_cls.h>
41 #define DPRINTK(format,args...) printk(KERN_DEBUG format,##args)
43 #define DPRINTK(format,args...)
46 /* The list of all installed classifier types */
48 static struct tcf_proto_ops
*tcf_proto_base
;
50 /* Protects list of registered TC modules. It is pure SMP lock. */
51 static DEFINE_RWLOCK(cls_mod_lock
);
53 /* Find classifier type by string name */
55 static struct tcf_proto_ops
* tcf_proto_lookup_ops(struct rtattr
*kind
)
57 struct tcf_proto_ops
*t
= NULL
;
60 read_lock(&cls_mod_lock
);
61 for (t
= tcf_proto_base
; t
; t
= t
->next
) {
62 if (rtattr_strcmp(kind
, t
->kind
) == 0) {
63 if (!try_module_get(t
->owner
))
68 read_unlock(&cls_mod_lock
);
73 /* Register(unregister) new classifier type */
75 int register_tcf_proto_ops(struct tcf_proto_ops
*ops
)
77 struct tcf_proto_ops
*t
, **tp
;
80 write_lock(&cls_mod_lock
);
81 for (tp
= &tcf_proto_base
; (t
= *tp
) != NULL
; tp
= &t
->next
)
82 if (!strcmp(ops
->kind
, t
->kind
))
89 write_unlock(&cls_mod_lock
);
93 int unregister_tcf_proto_ops(struct tcf_proto_ops
*ops
)
95 struct tcf_proto_ops
*t
, **tp
;
98 write_lock(&cls_mod_lock
);
99 for (tp
= &tcf_proto_base
; (t
=*tp
) != NULL
; tp
= &t
->next
)
108 write_unlock(&cls_mod_lock
);
112 static int tfilter_notify(struct sk_buff
*oskb
, struct nlmsghdr
*n
,
113 struct tcf_proto
*tp
, unsigned long fh
, int event
);
116 /* Select new prio value from the range, managed by kernel. */
118 static __inline__ u32
tcf_auto_prio(struct tcf_proto
*tp
)
120 u32 first
= TC_H_MAKE(0xC0000000U
,0U);
128 /* Add/change/delete/get a filter node */
130 static int tc_ctl_tfilter(struct sk_buff
*skb
, struct nlmsghdr
*n
, void *arg
)
138 struct net_device
*dev
;
140 struct tcf_proto
**back
, **chain
;
141 struct tcf_proto
*tp
;
142 struct tcf_proto_ops
*tp_ops
;
143 struct Qdisc_class_ops
*cops
;
151 protocol
= TC_H_MIN(t
->tcm_info
);
152 prio
= TC_H_MAJ(t
->tcm_info
);
154 parent
= t
->tcm_parent
;
158 /* If no priority is given, user wants we allocated it. */
159 if (n
->nlmsg_type
!= RTM_NEWTFILTER
|| !(n
->nlmsg_flags
&NLM_F_CREATE
))
161 prio
= TC_H_MAKE(0x80000000U
,0U);
164 /* Find head of filter chain. */
167 if ((dev
= __dev_get_by_index(t
->tcm_ifindex
)) == NULL
)
172 q
= dev
->qdisc_sleeping
;
174 } else if ((q
= qdisc_lookup(dev
, TC_H_MAJ(t
->tcm_parent
))) == NULL
)
177 /* Is it classful? */
178 if ((cops
= q
->ops
->cl_ops
) == NULL
)
181 /* Do we search for filter, attached to class? */
182 if (TC_H_MIN(parent
)) {
183 cl
= cops
->get(q
, parent
);
188 /* And the last stroke */
189 chain
= cops
->tcf_chain(q
, cl
);
194 /* Check the chain for existence of proto-tcf with this priority */
195 for (back
= chain
; (tp
=*back
) != NULL
; back
= &tp
->next
) {
196 if (tp
->prio
>= prio
) {
197 if (tp
->prio
== prio
) {
198 if (!nprio
|| (tp
->protocol
!= protocol
&& protocol
))
207 /* Proto-tcf does not exist, create new one */
209 if (tca
[TCA_KIND
-1] == NULL
|| !protocol
)
213 if (n
->nlmsg_type
!= RTM_NEWTFILTER
|| !(n
->nlmsg_flags
&NLM_F_CREATE
))
217 /* Create new proto tcf */
220 if ((tp
= kmalloc(sizeof(*tp
), GFP_KERNEL
)) == NULL
)
223 tp_ops
= tcf_proto_lookup_ops(tca
[TCA_KIND
-1]);
224 if (tp_ops
== NULL
) {
226 struct rtattr
*kind
= tca
[TCA_KIND
-1];
230 rtattr_strlcpy(name
, kind
, IFNAMSIZ
) < IFNAMSIZ
) {
232 request_module("cls_%s", name
);
234 tp_ops
= tcf_proto_lookup_ops(kind
);
235 /* We dropped the RTNL semaphore in order to
236 * perform the module load. So, even if we
237 * succeeded in loading the module we have to
238 * replay the request. We indicate this using
241 if (tp_ops
!= NULL
) {
242 module_put(tp_ops
->owner
);
250 memset(tp
, 0, sizeof(*tp
));
252 tp
->protocol
= protocol
;
253 tp
->prio
= nprio
? : tcf_auto_prio(*back
);
255 tp
->classify
= tp_ops
->classify
;
256 tp
->classid
= parent
;
257 if ((err
= tp_ops
->init(tp
)) != 0) {
258 module_put(tp_ops
->owner
);
263 qdisc_lock_tree(dev
);
266 qdisc_unlock_tree(dev
);
268 } else if (tca
[TCA_KIND
-1] && rtattr_strcmp(tca
[TCA_KIND
-1], tp
->ops
->kind
))
271 fh
= tp
->ops
->get(tp
, t
->tcm_handle
);
274 if (n
->nlmsg_type
== RTM_DELTFILTER
&& t
->tcm_handle
== 0) {
275 qdisc_lock_tree(dev
);
277 qdisc_unlock_tree(dev
);
279 tfilter_notify(skb
, n
, tp
, fh
, RTM_DELTFILTER
);
286 if (n
->nlmsg_type
!= RTM_NEWTFILTER
|| !(n
->nlmsg_flags
&NLM_F_CREATE
))
289 switch (n
->nlmsg_type
) {
292 if (n
->nlmsg_flags
&NLM_F_EXCL
)
296 err
= tp
->ops
->delete(tp
, fh
);
298 tfilter_notify(skb
, n
, tp
, fh
, RTM_DELTFILTER
);
301 err
= tfilter_notify(skb
, n
, tp
, fh
, RTM_NEWTFILTER
);
309 err
= tp
->ops
->change(tp
, cl
, t
->tcm_handle
, tca
, &fh
);
311 tfilter_notify(skb
, n
, tp
, fh
, RTM_NEWTFILTER
);
317 /* Replay the request. */
323 tcf_fill_node(struct sk_buff
*skb
, struct tcf_proto
*tp
, unsigned long fh
,
324 u32 pid
, u32 seq
, u16 flags
, int event
)
327 struct nlmsghdr
*nlh
;
328 unsigned char *b
= skb
->tail
;
330 nlh
= NLMSG_NEW(skb
, pid
, seq
, event
, sizeof(*tcm
), flags
);
331 tcm
= NLMSG_DATA(nlh
);
332 tcm
->tcm_family
= AF_UNSPEC
;
335 tcm
->tcm_ifindex
= tp
->q
->dev
->ifindex
;
336 tcm
->tcm_parent
= tp
->classid
;
337 tcm
->tcm_info
= TC_H_MAKE(tp
->prio
, tp
->protocol
);
338 RTA_PUT(skb
, TCA_KIND
, IFNAMSIZ
, tp
->ops
->kind
);
339 tcm
->tcm_handle
= fh
;
340 if (RTM_DELTFILTER
!= event
) {
342 if (tp
->ops
->dump
&& tp
->ops
->dump(tp
, fh
, skb
, tcm
) < 0)
345 nlh
->nlmsg_len
= skb
->tail
- b
;
350 skb_trim(skb
, b
- skb
->data
);
354 static int tfilter_notify(struct sk_buff
*oskb
, struct nlmsghdr
*n
,
355 struct tcf_proto
*tp
, unsigned long fh
, int event
)
358 u32 pid
= oskb
? NETLINK_CB(oskb
).pid
: 0;
360 skb
= alloc_skb(NLMSG_GOODSIZE
, GFP_KERNEL
);
364 if (tcf_fill_node(skb
, tp
, fh
, pid
, n
->nlmsg_seq
, 0, event
) <= 0) {
369 return rtnetlink_send(skb
, pid
, RTNLGRP_TC
, n
->nlmsg_flags
&NLM_F_ECHO
);
376 struct netlink_callback
*cb
;
379 static int tcf_node_dump(struct tcf_proto
*tp
, unsigned long n
, struct tcf_walker
*arg
)
381 struct tcf_dump_args
*a
= (void*)arg
;
383 return tcf_fill_node(a
->skb
, tp
, n
, NETLINK_CB(a
->cb
->skb
).pid
,
384 a
->cb
->nlh
->nlmsg_seq
, NLM_F_MULTI
, RTM_NEWTFILTER
);
387 static int tc_dump_tfilter(struct sk_buff
*skb
, struct netlink_callback
*cb
)
391 struct net_device
*dev
;
393 struct tcf_proto
*tp
, **chain
;
394 struct tcmsg
*tcm
= (struct tcmsg
*)NLMSG_DATA(cb
->nlh
);
395 unsigned long cl
= 0;
396 struct Qdisc_class_ops
*cops
;
397 struct tcf_dump_args arg
;
399 if (cb
->nlh
->nlmsg_len
< NLMSG_LENGTH(sizeof(*tcm
)))
401 if ((dev
= dev_get_by_index(tcm
->tcm_ifindex
)) == NULL
)
404 read_lock(&qdisc_tree_lock
);
405 if (!tcm
->tcm_parent
)
406 q
= dev
->qdisc_sleeping
;
408 q
= qdisc_lookup(dev
, TC_H_MAJ(tcm
->tcm_parent
));
411 if ((cops
= q
->ops
->cl_ops
) == NULL
)
413 if (TC_H_MIN(tcm
->tcm_parent
)) {
414 cl
= cops
->get(q
, tcm
->tcm_parent
);
418 chain
= cops
->tcf_chain(q
, cl
);
424 for (tp
=*chain
, t
=0; tp
; tp
= tp
->next
, t
++) {
425 if (t
< s_t
) continue;
426 if (TC_H_MAJ(tcm
->tcm_info
) &&
427 TC_H_MAJ(tcm
->tcm_info
) != tp
->prio
)
429 if (TC_H_MIN(tcm
->tcm_info
) &&
430 TC_H_MIN(tcm
->tcm_info
) != tp
->protocol
)
433 memset(&cb
->args
[1], 0, sizeof(cb
->args
)-sizeof(cb
->args
[0]));
434 if (cb
->args
[1] == 0) {
435 if (tcf_fill_node(skb
, tp
, 0, NETLINK_CB(cb
->skb
).pid
,
436 cb
->nlh
->nlmsg_seq
, NLM_F_MULTI
, RTM_NEWTFILTER
) <= 0) {
441 if (tp
->ops
->walk
== NULL
)
443 arg
.w
.fn
= tcf_node_dump
;
447 arg
.w
.skip
= cb
->args
[1]-1;
449 tp
->ops
->walk(tp
, &arg
.w
);
450 cb
->args
[1] = arg
.w
.count
+1;
461 read_unlock(&qdisc_tree_lock
);
467 tcf_exts_destroy(struct tcf_proto
*tp
, struct tcf_exts
*exts
)
469 #ifdef CONFIG_NET_CLS_ACT
471 tcf_action_destroy(exts
->action
, TCA_ACT_UNBIND
);
474 #elif defined CONFIG_NET_CLS_POLICE
476 tcf_police_release(exts
->police
, TCA_ACT_UNBIND
);
484 tcf_exts_validate(struct tcf_proto
*tp
, struct rtattr
**tb
,
485 struct rtattr
*rate_tlv
, struct tcf_exts
*exts
,
486 struct tcf_ext_map
*map
)
488 memset(exts
, 0, sizeof(*exts
));
490 #ifdef CONFIG_NET_CLS_ACT
493 struct tc_action
*act
;
495 if (map
->police
&& tb
[map
->police
-1]) {
496 act
= tcf_action_init_1(tb
[map
->police
-1], rate_tlv
, "police",
497 TCA_ACT_NOREPLACE
, TCA_ACT_BIND
, &err
);
501 act
->type
= TCA_OLD_COMPAT
;
503 } else if (map
->action
&& tb
[map
->action
-1]) {
504 act
= tcf_action_init(tb
[map
->action
-1], rate_tlv
, NULL
,
505 TCA_ACT_NOREPLACE
, TCA_ACT_BIND
, &err
);
512 #elif defined CONFIG_NET_CLS_POLICE
513 if (map
->police
&& tb
[map
->police
-1]) {
514 struct tcf_police
*p
;
516 p
= tcf_police_locate(tb
[map
->police
-1], rate_tlv
);
521 } else if (map
->action
&& tb
[map
->action
-1])
524 if ((map
->action
&& tb
[map
->action
-1]) ||
525 (map
->police
&& tb
[map
->police
-1]))
533 tcf_exts_change(struct tcf_proto
*tp
, struct tcf_exts
*dst
,
534 struct tcf_exts
*src
)
536 #ifdef CONFIG_NET_CLS_ACT
538 struct tc_action
*act
;
540 act
= xchg(&dst
->action
, src
->action
);
543 tcf_action_destroy(act
, TCA_ACT_UNBIND
);
545 #elif defined CONFIG_NET_CLS_POLICE
547 struct tcf_police
*p
;
549 p
= xchg(&dst
->police
, src
->police
);
552 tcf_police_release(p
, TCA_ACT_UNBIND
);
558 tcf_exts_dump(struct sk_buff
*skb
, struct tcf_exts
*exts
,
559 struct tcf_ext_map
*map
)
561 #ifdef CONFIG_NET_CLS_ACT
562 if (map
->action
&& exts
->action
) {
564 * again for backward compatible mode - we want
565 * to work with both old and new modes of entering
566 * tc data even if iproute2 was newer - jhs
568 struct rtattr
* p_rta
= (struct rtattr
*) skb
->tail
;
570 if (exts
->action
->type
!= TCA_OLD_COMPAT
) {
571 RTA_PUT(skb
, map
->action
, 0, NULL
);
572 if (tcf_action_dump(skb
, exts
->action
, 0, 0) < 0)
574 p_rta
->rta_len
= skb
->tail
- (u8
*)p_rta
;
575 } else if (map
->police
) {
576 RTA_PUT(skb
, map
->police
, 0, NULL
);
577 if (tcf_action_dump_old(skb
, exts
->action
, 0, 0) < 0)
579 p_rta
->rta_len
= skb
->tail
- (u8
*)p_rta
;
582 #elif defined CONFIG_NET_CLS_POLICE
583 if (map
->police
&& exts
->police
) {
584 struct rtattr
* p_rta
= (struct rtattr
*) skb
->tail
;
586 RTA_PUT(skb
, map
->police
, 0, NULL
);
588 if (tcf_police_dump(skb
, exts
->police
) < 0)
591 p_rta
->rta_len
= skb
->tail
- (u8
*)p_rta
;
595 rtattr_failure
: __attribute__ ((unused
))
600 tcf_exts_dump_stats(struct sk_buff
*skb
, struct tcf_exts
*exts
,
601 struct tcf_ext_map
*map
)
603 #ifdef CONFIG_NET_CLS_ACT
605 if (tcf_action_copy_stats(skb
, exts
->action
, 1) < 0)
607 #elif defined CONFIG_NET_CLS_POLICE
609 if (tcf_police_dump_stats(skb
, exts
->police
) < 0)
613 rtattr_failure
: __attribute__ ((unused
))
617 static int __init
tc_filter_init(void)
619 struct rtnetlink_link
*link_p
= rtnetlink_links
[PF_UNSPEC
];
621 /* Setup rtnetlink links. It is made here to avoid
622 exporting large number of public symbols.
626 link_p
[RTM_NEWTFILTER
-RTM_BASE
].doit
= tc_ctl_tfilter
;
627 link_p
[RTM_DELTFILTER
-RTM_BASE
].doit
= tc_ctl_tfilter
;
628 link_p
[RTM_GETTFILTER
-RTM_BASE
].doit
= tc_ctl_tfilter
;
629 link_p
[RTM_GETTFILTER
-RTM_BASE
].dumpit
= tc_dump_tfilter
;
634 subsys_initcall(tc_filter_init
);
636 EXPORT_SYMBOL(register_tcf_proto_ops
);
637 EXPORT_SYMBOL(unregister_tcf_proto_ops
);
638 EXPORT_SYMBOL(tcf_exts_validate
);
639 EXPORT_SYMBOL(tcf_exts_destroy
);
640 EXPORT_SYMBOL(tcf_exts_change
);
641 EXPORT_SYMBOL(tcf_exts_dump
);
642 EXPORT_SYMBOL(tcf_exts_dump_stats
);