2 * net/sched/act_police.c Input police filter
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>
10 * J Hadi Salim (action changes)
13 #include <linux/module.h>
14 #include <linux/types.h>
15 #include <linux/kernel.h>
16 #include <linux/string.h>
17 #include <linux/errno.h>
18 #include <linux/skbuff.h>
19 #include <linux/rtnetlink.h>
20 #include <linux/init.h>
21 #include <linux/slab.h>
22 #include <net/act_api.h>
23 #include <net/netlink.h>
26 struct tcf_common common
;
35 struct psched_ratecfg rate
;
37 struct psched_ratecfg peak
;
41 #define to_police(pc) ((struct tcf_police *)pc)
43 #define POL_TAB_MASK 15
45 /* old policer structure from before tc actions */
46 struct tc_police_compat
{
52 struct tc_ratespec rate
;
53 struct tc_ratespec peakrate
;
56 /* Each policer is serialized by its individual spinlock */
58 static int police_net_id
;
59 static struct tc_action_ops act_police_ops
;
61 static int tcf_act_police_walker(struct net
*net
, struct sk_buff
*skb
,
62 struct netlink_callback
*cb
, int type
,
63 const struct tc_action_ops
*ops
)
65 struct tc_action_net
*tn
= net_generic(net
, police_net_id
);
66 struct tcf_hashinfo
*hinfo
= tn
->hinfo
;
67 int err
= 0, index
= -1, i
= 0, s_i
= 0, n_i
= 0;
70 spin_lock_bh(&hinfo
->lock
);
74 for (i
= 0; i
< (POL_TAB_MASK
+ 1); i
++) {
75 struct hlist_head
*head
;
78 head
= &hinfo
->htab
[tcf_hash(i
, POL_TAB_MASK
)];
80 hlist_for_each_entry_rcu(p
, head
, tcfc_head
) {
84 nest
= nla_nest_start(skb
, index
);
87 if (type
== RTM_DELACTION
)
88 err
= tcf_action_dump_1(skb
, (struct tc_action
*)p
, 0, 1);
90 err
= tcf_action_dump_1(skb
, (struct tc_action
*)p
, 0, 0);
93 nla_nest_cancel(skb
, nest
);
96 nla_nest_end(skb
, nest
);
101 spin_unlock_bh(&hinfo
->lock
);
107 nla_nest_cancel(skb
, nest
);
111 static const struct nla_policy police_policy
[TCA_POLICE_MAX
+ 1] = {
112 [TCA_POLICE_RATE
] = { .len
= TC_RTAB_SIZE
},
113 [TCA_POLICE_PEAKRATE
] = { .len
= TC_RTAB_SIZE
},
114 [TCA_POLICE_AVRATE
] = { .type
= NLA_U32
},
115 [TCA_POLICE_RESULT
] = { .type
= NLA_U32
},
118 static int tcf_act_police_init(struct net
*net
, struct nlattr
*nla
,
119 struct nlattr
*est
, struct tc_action
**a
,
123 struct nlattr
*tb
[TCA_POLICE_MAX
+ 1];
124 struct tc_police
*parm
;
125 struct tcf_police
*police
;
126 struct qdisc_rate_table
*R_tab
= NULL
, *P_tab
= NULL
;
127 struct tc_action_net
*tn
= net_generic(net
, police_net_id
);
133 err
= nla_parse_nested(tb
, TCA_POLICE_MAX
, nla
, police_policy
);
137 if (tb
[TCA_POLICE_TBF
] == NULL
)
139 size
= nla_len(tb
[TCA_POLICE_TBF
]);
140 if (size
!= sizeof(*parm
) && size
!= sizeof(struct tc_police_compat
))
142 parm
= nla_data(tb
[TCA_POLICE_TBF
]);
145 if (tcf_hash_check(tn
, parm
->index
, a
, bind
)) {
152 ret
= tcf_hash_create(tn
, parm
->index
, NULL
, a
,
153 &act_police_ops
, bind
, false);
160 police
= to_police(*a
);
161 if (parm
->rate
.rate
) {
163 R_tab
= qdisc_get_rtab(&parm
->rate
, tb
[TCA_POLICE_RATE
]);
167 if (parm
->peakrate
.rate
) {
168 P_tab
= qdisc_get_rtab(&parm
->peakrate
,
169 tb
[TCA_POLICE_PEAKRATE
]);
175 spin_lock_bh(&police
->tcf_lock
);
177 err
= gen_replace_estimator(&police
->tcf_bstats
, NULL
,
178 &police
->tcf_rate_est
,
183 } else if (tb
[TCA_POLICE_AVRATE
] &&
184 (ret
== ACT_P_CREATED
||
185 !gen_estimator_active(&police
->tcf_bstats
,
186 &police
->tcf_rate_est
))) {
191 /* No failure allowed after this point */
192 police
->tcfp_mtu
= parm
->mtu
;
193 if (police
->tcfp_mtu
== 0) {
194 police
->tcfp_mtu
= ~0;
196 police
->tcfp_mtu
= 255 << R_tab
->rate
.cell_log
;
199 police
->rate_present
= true;
200 psched_ratecfg_precompute(&police
->rate
, &R_tab
->rate
, 0);
201 qdisc_put_rtab(R_tab
);
203 police
->rate_present
= false;
206 police
->peak_present
= true;
207 psched_ratecfg_precompute(&police
->peak
, &P_tab
->rate
, 0);
208 qdisc_put_rtab(P_tab
);
210 police
->peak_present
= false;
213 if (tb
[TCA_POLICE_RESULT
])
214 police
->tcfp_result
= nla_get_u32(tb
[TCA_POLICE_RESULT
]);
215 police
->tcfp_burst
= PSCHED_TICKS2NS(parm
->burst
);
216 police
->tcfp_toks
= police
->tcfp_burst
;
217 if (police
->peak_present
) {
218 police
->tcfp_mtu_ptoks
= (s64
) psched_l2t_ns(&police
->peak
,
220 police
->tcfp_ptoks
= police
->tcfp_mtu_ptoks
;
222 police
->tcf_action
= parm
->action
;
224 if (tb
[TCA_POLICE_AVRATE
])
225 police
->tcfp_ewma_rate
= nla_get_u32(tb
[TCA_POLICE_AVRATE
]);
227 spin_unlock_bh(&police
->tcf_lock
);
228 if (ret
!= ACT_P_CREATED
)
231 police
->tcfp_t_c
= ktime_get_ns();
232 tcf_hash_insert(tn
, *a
);
237 spin_unlock_bh(&police
->tcf_lock
);
239 qdisc_put_rtab(P_tab
);
240 qdisc_put_rtab(R_tab
);
241 if (ret
== ACT_P_CREATED
)
242 tcf_hash_cleanup(*a
, est
);
246 static int tcf_act_police(struct sk_buff
*skb
, const struct tc_action
*a
,
247 struct tcf_result
*res
)
249 struct tcf_police
*police
= to_police(a
);
254 spin_lock(&police
->tcf_lock
);
256 bstats_update(&police
->tcf_bstats
, skb
);
257 tcf_lastuse_update(&police
->tcf_tm
);
259 if (police
->tcfp_ewma_rate
&&
260 police
->tcf_rate_est
.bps
>= police
->tcfp_ewma_rate
) {
261 police
->tcf_qstats
.overlimits
++;
262 if (police
->tcf_action
== TC_ACT_SHOT
)
263 police
->tcf_qstats
.drops
++;
264 spin_unlock(&police
->tcf_lock
);
265 return police
->tcf_action
;
268 if (qdisc_pkt_len(skb
) <= police
->tcfp_mtu
) {
269 if (!police
->rate_present
) {
270 spin_unlock(&police
->tcf_lock
);
271 return police
->tcfp_result
;
274 now
= ktime_get_ns();
275 toks
= min_t(s64
, now
- police
->tcfp_t_c
,
277 if (police
->peak_present
) {
278 ptoks
= toks
+ police
->tcfp_ptoks
;
279 if (ptoks
> police
->tcfp_mtu_ptoks
)
280 ptoks
= police
->tcfp_mtu_ptoks
;
281 ptoks
-= (s64
) psched_l2t_ns(&police
->peak
,
284 toks
+= police
->tcfp_toks
;
285 if (toks
> police
->tcfp_burst
)
286 toks
= police
->tcfp_burst
;
287 toks
-= (s64
) psched_l2t_ns(&police
->rate
, qdisc_pkt_len(skb
));
288 if ((toks
|ptoks
) >= 0) {
289 police
->tcfp_t_c
= now
;
290 police
->tcfp_toks
= toks
;
291 police
->tcfp_ptoks
= ptoks
;
292 spin_unlock(&police
->tcf_lock
);
293 return police
->tcfp_result
;
297 police
->tcf_qstats
.overlimits
++;
298 if (police
->tcf_action
== TC_ACT_SHOT
)
299 police
->tcf_qstats
.drops
++;
300 spin_unlock(&police
->tcf_lock
);
301 return police
->tcf_action
;
305 tcf_act_police_dump(struct sk_buff
*skb
, struct tc_action
*a
, int bind
, int ref
)
307 unsigned char *b
= skb_tail_pointer(skb
);
308 struct tcf_police
*police
= to_police(a
);
309 struct tc_police opt
= {
310 .index
= police
->tcf_index
,
311 .action
= police
->tcf_action
,
312 .mtu
= police
->tcfp_mtu
,
313 .burst
= PSCHED_NS2TICKS(police
->tcfp_burst
),
314 .refcnt
= police
->tcf_refcnt
- ref
,
315 .bindcnt
= police
->tcf_bindcnt
- bind
,
319 if (police
->rate_present
)
320 psched_ratecfg_getrate(&opt
.rate
, &police
->rate
);
321 if (police
->peak_present
)
322 psched_ratecfg_getrate(&opt
.peakrate
, &police
->peak
);
323 if (nla_put(skb
, TCA_POLICE_TBF
, sizeof(opt
), &opt
))
324 goto nla_put_failure
;
325 if (police
->tcfp_result
&&
326 nla_put_u32(skb
, TCA_POLICE_RESULT
, police
->tcfp_result
))
327 goto nla_put_failure
;
328 if (police
->tcfp_ewma_rate
&&
329 nla_put_u32(skb
, TCA_POLICE_AVRATE
, police
->tcfp_ewma_rate
))
330 goto nla_put_failure
;
332 t
.install
= jiffies_to_clock_t(jiffies
- police
->tcf_tm
.install
);
333 t
.lastuse
= jiffies_to_clock_t(jiffies
- police
->tcf_tm
.lastuse
);
334 t
.firstuse
= jiffies_to_clock_t(jiffies
- police
->tcf_tm
.firstuse
);
335 t
.expires
= jiffies_to_clock_t(police
->tcf_tm
.expires
);
336 if (nla_put_64bit(skb
, TCA_POLICE_TM
, sizeof(t
), &t
, TCA_POLICE_PAD
))
337 goto nla_put_failure
;
346 static int tcf_police_search(struct net
*net
, struct tc_action
**a
, u32 index
)
348 struct tc_action_net
*tn
= net_generic(net
, police_net_id
);
350 return tcf_hash_search(tn
, a
, index
);
353 MODULE_AUTHOR("Alexey Kuznetsov");
354 MODULE_DESCRIPTION("Policing actions");
355 MODULE_LICENSE("GPL");
357 static struct tc_action_ops act_police_ops
= {
359 .type
= TCA_ID_POLICE
,
360 .owner
= THIS_MODULE
,
361 .act
= tcf_act_police
,
362 .dump
= tcf_act_police_dump
,
363 .init
= tcf_act_police_init
,
364 .walk
= tcf_act_police_walker
,
365 .lookup
= tcf_police_search
,
366 .size
= sizeof(struct tcf_police
),
369 static __net_init
int police_init_net(struct net
*net
)
371 struct tc_action_net
*tn
= net_generic(net
, police_net_id
);
373 return tc_action_net_init(tn
, &act_police_ops
, POL_TAB_MASK
);
376 static void __net_exit
police_exit_net(struct net
*net
)
378 struct tc_action_net
*tn
= net_generic(net
, police_net_id
);
380 tc_action_net_exit(tn
);
383 static struct pernet_operations police_net_ops
= {
384 .init
= police_init_net
,
385 .exit
= police_exit_net
,
386 .id
= &police_net_id
,
387 .size
= sizeof(struct tc_action_net
),
391 police_init_module(void)
393 return tcf_register_action(&act_police_ops
, &police_net_ops
);
397 police_cleanup_module(void)
399 tcf_unregister_action(&act_police_ops
, &police_net_ops
);
402 module_init(police_init_module
);
403 module_exit(police_cleanup_module
);