2005-04-17 06:20:36 +08:00
|
|
|
/*
|
|
|
|
* net/sched/cls_u32.c Ugly (or Universal) 32bit key Packet Classifier.
|
|
|
|
*
|
|
|
|
* This program is free software; you can redistribute it and/or
|
|
|
|
* modify it under the terms of the GNU General Public License
|
|
|
|
* as published by the Free Software Foundation; either version
|
|
|
|
* 2 of the License, or (at your option) any later version.
|
|
|
|
*
|
|
|
|
* Authors: Alexey Kuznetsov, <kuznet@ms2.inr.ac.ru>
|
|
|
|
*
|
|
|
|
* The filters are packed to hash tables of key nodes
|
|
|
|
* with a set of 32bit key/mask pairs at every node.
|
|
|
|
* Nodes reference next level hash tables etc.
|
|
|
|
*
|
|
|
|
* This scheme is the best universal classifier I managed to
|
|
|
|
* invent; it is not super-fast, but it is not slow (provided you
|
|
|
|
* program it correctly), and general enough. And its relative
|
|
|
|
* speed grows as the number of rules becomes larger.
|
|
|
|
*
|
|
|
|
* It seems that it represents the best middle point between
|
|
|
|
* speed and manageability both by human and by machine.
|
|
|
|
*
|
|
|
|
* It is especially useful for link sharing combined with QoS;
|
|
|
|
* pure RSVP doesn't need such a general approach and can use
|
|
|
|
* much simpler (and faster) schemes, sort of cls_rsvp.c.
|
|
|
|
*
|
|
|
|
* JHS: We should remove the CONFIG_NET_CLS_IND from here
|
|
|
|
* eventually when the meta match extension is made available
|
|
|
|
*
|
|
|
|
* nfmark match added by Catalin(ux aka Dino) BOIE <catab at umbrella.ro>
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include <linux/module.h>
|
include cleanup: Update gfp.h and slab.h includes to prepare for breaking implicit slab.h inclusion from percpu.h
percpu.h is included by sched.h and module.h and thus ends up being
included when building most .c files. percpu.h includes slab.h which
in turn includes gfp.h making everything defined by the two files
universally available and complicating inclusion dependencies.
percpu.h -> slab.h dependency is about to be removed. Prepare for
this change by updating users of gfp and slab facilities include those
headers directly instead of assuming availability. As this conversion
needs to touch large number of source files, the following script is
used as the basis of conversion.
http://userweb.kernel.org/~tj/misc/slabh-sweep.py
The script does the followings.
* Scan files for gfp and slab usages and update includes such that
only the necessary includes are there. ie. if only gfp is used,
gfp.h, if slab is used, slab.h.
* When the script inserts a new include, it looks at the include
blocks and try to put the new include such that its order conforms
to its surrounding. It's put in the include block which contains
core kernel includes, in the same order that the rest are ordered -
alphabetical, Christmas tree, rev-Xmas-tree or at the end if there
doesn't seem to be any matching order.
* If the script can't find a place to put a new include (mostly
because the file doesn't have fitting include block), it prints out
an error message indicating which .h file needs to be added to the
file.
The conversion was done in the following steps.
1. The initial automatic conversion of all .c files updated slightly
over 4000 files, deleting around 700 includes and adding ~480 gfp.h
and ~3000 slab.h inclusions. The script emitted errors for ~400
files.
2. Each error was manually checked. Some didn't need the inclusion,
some needed manual addition while adding it to implementation .h or
embedding .c file was more appropriate for others. This step added
inclusions to around 150 files.
3. The script was run again and the output was compared to the edits
from #2 to make sure no file was left behind.
4. Several build tests were done and a couple of problems were fixed.
e.g. lib/decompress_*.c used malloc/free() wrappers around slab
APIs requiring slab.h to be added manually.
5. The script was run on all .h files but without automatically
editing them as sprinkling gfp.h and slab.h inclusions around .h
files could easily lead to inclusion dependency hell. Most gfp.h
inclusion directives were ignored as stuff from gfp.h was usually
wildly available and often used in preprocessor macros. Each
slab.h inclusion directive was examined and added manually as
necessary.
6. percpu.h was updated not to include slab.h.
7. Build test were done on the following configurations and failures
were fixed. CONFIG_GCOV_KERNEL was turned off for all tests (as my
distributed build env didn't work with gcov compiles) and a few
more options had to be turned off depending on archs to make things
build (like ipr on powerpc/64 which failed due to missing writeq).
* x86 and x86_64 UP and SMP allmodconfig and a custom test config.
* powerpc and powerpc64 SMP allmodconfig
* sparc and sparc64 SMP allmodconfig
* ia64 SMP allmodconfig
* s390 SMP allmodconfig
* alpha SMP allmodconfig
* um on x86_64 SMP allmodconfig
8. percpu.h modifications were reverted so that it could be applied as
a separate patch and serve as bisection point.
Given the fact that I had only a couple of failures from tests on step
6, I'm fairly confident about the coverage of this conversion patch.
If there is a breakage, it's likely to be something in one of the arch
headers which should be easily discoverable easily on most builds of
the specific arch.
Signed-off-by: Tejun Heo <tj@kernel.org>
Guess-its-ok-by: Christoph Lameter <cl@linux-foundation.org>
Cc: Ingo Molnar <mingo@redhat.com>
Cc: Lee Schermerhorn <Lee.Schermerhorn@hp.com>
2010-03-24 16:04:11 +08:00
|
|
|
#include <linux/slab.h>
|
2005-04-17 06:20:36 +08:00
|
|
|
#include <linux/types.h>
|
|
|
|
#include <linux/kernel.h>
|
|
|
|
#include <linux/string.h>
|
|
|
|
#include <linux/errno.h>
|
2014-09-13 11:09:16 +08:00
|
|
|
#include <linux/percpu.h>
|
2005-04-17 06:20:36 +08:00
|
|
|
#include <linux/rtnetlink.h>
|
|
|
|
#include <linux/skbuff.h>
|
2014-07-18 08:34:53 +08:00
|
|
|
#include <linux/bitmap.h>
|
2007-07-03 13:49:07 +08:00
|
|
|
#include <net/netlink.h>
|
2005-04-17 06:20:36 +08:00
|
|
|
#include <net/act_api.h>
|
|
|
|
#include <net/pkt_cls.h>
|
2016-02-17 13:17:09 +08:00
|
|
|
#include <linux/netdevice.h>
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2011-01-20 03:26:56 +08:00
|
|
|
struct tc_u_knode {
|
2014-09-13 11:09:16 +08:00
|
|
|
struct tc_u_knode __rcu *next;
|
2005-04-17 06:20:36 +08:00
|
|
|
u32 handle;
|
2014-09-13 11:09:16 +08:00
|
|
|
struct tc_u_hnode __rcu *ht_up;
|
2005-04-17 06:20:36 +08:00
|
|
|
struct tcf_exts exts;
|
|
|
|
#ifdef CONFIG_NET_CLS_IND
|
2014-01-10 08:14:02 +08:00
|
|
|
int ifindex;
|
2005-04-17 06:20:36 +08:00
|
|
|
#endif
|
|
|
|
u8 fshift;
|
|
|
|
struct tcf_result res;
|
2014-09-13 11:09:16 +08:00
|
|
|
struct tc_u_hnode __rcu *ht_down;
|
2005-04-17 06:20:36 +08:00
|
|
|
#ifdef CONFIG_CLS_U32_PERF
|
2014-09-13 11:08:47 +08:00
|
|
|
struct tc_u32_pcnt __percpu *pf;
|
2005-04-17 06:20:36 +08:00
|
|
|
#endif
|
2016-02-26 23:54:39 +08:00
|
|
|
u32 flags;
|
2005-04-17 06:20:36 +08:00
|
|
|
#ifdef CONFIG_CLS_U32_MARK
|
2014-09-13 11:08:47 +08:00
|
|
|
u32 val;
|
|
|
|
u32 mask;
|
|
|
|
u32 __percpu *pcpu_success;
|
2005-04-17 06:20:36 +08:00
|
|
|
#endif
|
2014-09-13 11:09:16 +08:00
|
|
|
struct tcf_proto *tp;
|
|
|
|
struct rcu_head rcu;
|
2014-09-18 02:11:46 +08:00
|
|
|
/* The 'sel' field MUST be the last field in structure to allow for
|
|
|
|
* tc_u32_keys allocated at end of structure.
|
|
|
|
*/
|
|
|
|
struct tc_u32_sel sel;
|
2005-04-17 06:20:36 +08:00
|
|
|
};
|
|
|
|
|
2011-01-20 03:26:56 +08:00
|
|
|
struct tc_u_hnode {
|
2014-09-13 11:09:16 +08:00
|
|
|
struct tc_u_hnode __rcu *next;
|
2005-04-17 06:20:36 +08:00
|
|
|
u32 handle;
|
|
|
|
u32 prio;
|
|
|
|
struct tc_u_common *tp_c;
|
|
|
|
int refcnt;
|
2011-01-20 03:26:56 +08:00
|
|
|
unsigned int divisor;
|
2014-09-13 11:09:16 +08:00
|
|
|
struct rcu_head rcu;
|
2015-03-10 08:03:40 +08:00
|
|
|
/* The 'ht' field MUST be the last field in structure to allow for
|
|
|
|
* more entries allocated at end of structure.
|
|
|
|
*/
|
|
|
|
struct tc_u_knode __rcu *ht[1];
|
2005-04-17 06:20:36 +08:00
|
|
|
};
|
|
|
|
|
2011-01-20 03:26:56 +08:00
|
|
|
struct tc_u_common {
|
2014-09-13 11:09:16 +08:00
|
|
|
struct tc_u_hnode __rcu *hlist;
|
2005-04-17 06:20:36 +08:00
|
|
|
struct Qdisc *q;
|
|
|
|
int refcnt;
|
|
|
|
u32 hgenerator;
|
2014-09-13 11:09:16 +08:00
|
|
|
struct rcu_head rcu;
|
2005-04-17 06:20:36 +08:00
|
|
|
};
|
|
|
|
|
2011-01-20 03:26:56 +08:00
|
|
|
static inline unsigned int u32_hash_fold(__be32 key,
|
|
|
|
const struct tc_u32_sel *sel,
|
|
|
|
u8 fshift)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
2011-01-20 03:26:56 +08:00
|
|
|
unsigned int h = ntohl(key & sel->hmask) >> fshift;
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
return h;
|
|
|
|
}
|
|
|
|
|
2016-09-18 20:45:33 +08:00
|
|
|
static int u32_classify(struct sk_buff *skb, const struct tcf_proto *tp,
|
|
|
|
struct tcf_result *res)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
|
|
|
struct {
|
|
|
|
struct tc_u_knode *knode;
|
2010-06-02 22:32:42 +08:00
|
|
|
unsigned int off;
|
2005-04-17 06:20:36 +08:00
|
|
|
} stack[TC_U32_MAXDEPTH];
|
|
|
|
|
2014-09-13 11:09:16 +08:00
|
|
|
struct tc_u_hnode *ht = rcu_dereference_bh(tp->root);
|
2010-06-02 22:32:42 +08:00
|
|
|
unsigned int off = skb_network_offset(skb);
|
2005-04-17 06:20:36 +08:00
|
|
|
struct tc_u_knode *n;
|
|
|
|
int sdepth = 0;
|
|
|
|
int off2 = 0;
|
|
|
|
int sel = 0;
|
|
|
|
#ifdef CONFIG_CLS_U32_PERF
|
|
|
|
int j;
|
|
|
|
#endif
|
|
|
|
int i, r;
|
|
|
|
|
|
|
|
next_ht:
|
2014-09-13 11:09:16 +08:00
|
|
|
n = rcu_dereference_bh(ht->ht[sel]);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
next_knode:
|
|
|
|
if (n) {
|
|
|
|
struct tc_u32_key *key = n->sel.keys;
|
|
|
|
|
|
|
|
#ifdef CONFIG_CLS_U32_PERF
|
2014-09-13 11:08:47 +08:00
|
|
|
__this_cpu_inc(n->pf->rcnt);
|
2005-04-17 06:20:36 +08:00
|
|
|
j = 0;
|
|
|
|
#endif
|
|
|
|
|
2016-05-13 08:08:23 +08:00
|
|
|
if (tc_skip_sw(n->flags)) {
|
|
|
|
n = rcu_dereference_bh(n->next);
|
|
|
|
goto next_knode;
|
|
|
|
}
|
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
#ifdef CONFIG_CLS_U32_MARK
|
2014-09-13 11:08:47 +08:00
|
|
|
if ((skb->mark & n->mask) != n->val) {
|
2014-09-13 11:09:16 +08:00
|
|
|
n = rcu_dereference_bh(n->next);
|
2005-04-17 06:20:36 +08:00
|
|
|
goto next_knode;
|
|
|
|
} else {
|
2014-09-13 11:08:47 +08:00
|
|
|
__this_cpu_inc(*n->pcpu_success);
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
2011-01-20 03:26:56 +08:00
|
|
|
for (i = n->sel.nkeys; i > 0; i--, key++) {
|
2010-08-02 21:44:13 +08:00
|
|
|
int toff = off + key->off + (off2 & key->offmask);
|
2011-02-21 00:14:23 +08:00
|
|
|
__be32 *data, hdata;
|
2010-06-02 22:32:42 +08:00
|
|
|
|
2010-10-04 10:28:36 +08:00
|
|
|
if (skb_headroom(skb) + toff > INT_MAX)
|
2010-08-02 21:44:13 +08:00
|
|
|
goto out;
|
|
|
|
|
2011-02-21 00:14:23 +08:00
|
|
|
data = skb_header_pointer(skb, toff, 4, &hdata);
|
2010-06-02 22:32:42 +08:00
|
|
|
if (!data)
|
|
|
|
goto out;
|
|
|
|
if ((*data ^ key->val) & key->mask) {
|
2014-09-13 11:09:16 +08:00
|
|
|
n = rcu_dereference_bh(n->next);
|
2005-04-17 06:20:36 +08:00
|
|
|
goto next_knode;
|
|
|
|
}
|
|
|
|
#ifdef CONFIG_CLS_U32_PERF
|
2014-09-13 11:08:47 +08:00
|
|
|
__this_cpu_inc(n->pf->kcnts[j]);
|
2005-04-17 06:20:36 +08:00
|
|
|
j++;
|
|
|
|
#endif
|
|
|
|
}
|
2014-09-13 11:09:16 +08:00
|
|
|
|
|
|
|
ht = rcu_dereference_bh(n->ht_down);
|
|
|
|
if (!ht) {
|
2005-04-17 06:20:36 +08:00
|
|
|
check_terminal:
|
2011-01-20 03:26:56 +08:00
|
|
|
if (n->sel.flags & TC_U32_TERMINAL) {
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
*res = n->res;
|
|
|
|
#ifdef CONFIG_NET_CLS_IND
|
2014-01-10 08:14:02 +08:00
|
|
|
if (!tcf_match_indev(skb, n->ifindex)) {
|
2014-09-13 11:09:16 +08:00
|
|
|
n = rcu_dereference_bh(n->next);
|
2005-04-17 06:20:36 +08:00
|
|
|
goto next_knode;
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
#ifdef CONFIG_CLS_U32_PERF
|
2014-09-13 11:08:47 +08:00
|
|
|
__this_cpu_inc(n->pf->rhit);
|
2005-04-17 06:20:36 +08:00
|
|
|
#endif
|
|
|
|
r = tcf_exts_exec(skb, &n->exts, res);
|
|
|
|
if (r < 0) {
|
2014-09-13 11:09:16 +08:00
|
|
|
n = rcu_dereference_bh(n->next);
|
2005-04-17 06:20:36 +08:00
|
|
|
goto next_knode;
|
|
|
|
}
|
|
|
|
|
|
|
|
return r;
|
|
|
|
}
|
2014-09-13 11:09:16 +08:00
|
|
|
n = rcu_dereference_bh(n->next);
|
2005-04-17 06:20:36 +08:00
|
|
|
goto next_knode;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* PUSH */
|
|
|
|
if (sdepth >= TC_U32_MAXDEPTH)
|
|
|
|
goto deadloop;
|
|
|
|
stack[sdepth].knode = n;
|
2010-06-02 22:32:42 +08:00
|
|
|
stack[sdepth].off = off;
|
2005-04-17 06:20:36 +08:00
|
|
|
sdepth++;
|
|
|
|
|
2014-09-13 11:09:16 +08:00
|
|
|
ht = rcu_dereference_bh(n->ht_down);
|
2005-04-17 06:20:36 +08:00
|
|
|
sel = 0;
|
2010-06-02 22:32:42 +08:00
|
|
|
if (ht->divisor) {
|
2011-02-21 00:14:23 +08:00
|
|
|
__be32 *data, hdata;
|
2010-06-02 22:32:42 +08:00
|
|
|
|
|
|
|
data = skb_header_pointer(skb, off + n->sel.hoff, 4,
|
2011-02-21 00:14:23 +08:00
|
|
|
&hdata);
|
2010-06-02 22:32:42 +08:00
|
|
|
if (!data)
|
|
|
|
goto out;
|
|
|
|
sel = ht->divisor & u32_hash_fold(*data, &n->sel,
|
|
|
|
n->fshift);
|
|
|
|
}
|
2011-01-20 03:26:56 +08:00
|
|
|
if (!(n->sel.flags & (TC_U32_VAROFFSET | TC_U32_OFFSET | TC_U32_EAT)))
|
2005-04-17 06:20:36 +08:00
|
|
|
goto next_ht;
|
|
|
|
|
2011-01-20 03:26:56 +08:00
|
|
|
if (n->sel.flags & (TC_U32_OFFSET | TC_U32_VAROFFSET)) {
|
2005-04-17 06:20:36 +08:00
|
|
|
off2 = n->sel.off + 3;
|
2010-06-02 22:32:42 +08:00
|
|
|
if (n->sel.flags & TC_U32_VAROFFSET) {
|
2011-02-21 00:14:23 +08:00
|
|
|
__be16 *data, hdata;
|
2010-06-02 22:32:42 +08:00
|
|
|
|
|
|
|
data = skb_header_pointer(skb,
|
|
|
|
off + n->sel.offoff,
|
2011-02-21 00:14:23 +08:00
|
|
|
2, &hdata);
|
2010-06-02 22:32:42 +08:00
|
|
|
if (!data)
|
|
|
|
goto out;
|
|
|
|
off2 += ntohs(n->sel.offmask & *data) >>
|
|
|
|
n->sel.offshift;
|
|
|
|
}
|
2005-04-17 06:20:36 +08:00
|
|
|
off2 &= ~3;
|
|
|
|
}
|
2011-01-20 03:26:56 +08:00
|
|
|
if (n->sel.flags & TC_U32_EAT) {
|
2010-06-02 22:32:42 +08:00
|
|
|
off += off2;
|
2005-04-17 06:20:36 +08:00
|
|
|
off2 = 0;
|
|
|
|
}
|
|
|
|
|
2010-06-02 22:32:42 +08:00
|
|
|
if (off < skb->len)
|
2005-04-17 06:20:36 +08:00
|
|
|
goto next_ht;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* POP */
|
|
|
|
if (sdepth--) {
|
|
|
|
n = stack[sdepth].knode;
|
2014-09-13 11:09:16 +08:00
|
|
|
ht = rcu_dereference_bh(n->ht_up);
|
2010-06-02 22:32:42 +08:00
|
|
|
off = stack[sdepth].off;
|
2005-04-17 06:20:36 +08:00
|
|
|
goto check_terminal;
|
|
|
|
}
|
2010-06-02 22:32:42 +08:00
|
|
|
out:
|
2005-04-17 06:20:36 +08:00
|
|
|
return -1;
|
|
|
|
|
|
|
|
deadloop:
|
2012-05-14 05:56:26 +08:00
|
|
|
net_warn_ratelimited("cls_u32: dead loop\n");
|
2005-04-17 06:20:36 +08:00
|
|
|
return -1;
|
|
|
|
}
|
|
|
|
|
2016-09-18 20:45:33 +08:00
|
|
|
static struct tc_u_hnode *u32_lookup_ht(struct tc_u_common *tp_c, u32 handle)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
|
|
|
struct tc_u_hnode *ht;
|
|
|
|
|
2014-09-13 11:09:16 +08:00
|
|
|
for (ht = rtnl_dereference(tp_c->hlist);
|
|
|
|
ht;
|
|
|
|
ht = rtnl_dereference(ht->next))
|
2005-04-17 06:20:36 +08:00
|
|
|
if (ht->handle == handle)
|
|
|
|
break;
|
|
|
|
|
|
|
|
return ht;
|
|
|
|
}
|
|
|
|
|
2016-09-18 20:45:33 +08:00
|
|
|
static struct tc_u_knode *u32_lookup_key(struct tc_u_hnode *ht, u32 handle)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
2011-01-20 03:26:56 +08:00
|
|
|
unsigned int sel;
|
2005-04-17 06:20:36 +08:00
|
|
|
struct tc_u_knode *n = NULL;
|
|
|
|
|
|
|
|
sel = TC_U32_HASH(handle);
|
|
|
|
if (sel > ht->divisor)
|
|
|
|
goto out;
|
|
|
|
|
2014-09-13 11:09:16 +08:00
|
|
|
for (n = rtnl_dereference(ht->ht[sel]);
|
|
|
|
n;
|
|
|
|
n = rtnl_dereference(n->next))
|
2005-04-17 06:20:36 +08:00
|
|
|
if (n->handle == handle)
|
|
|
|
break;
|
|
|
|
out:
|
|
|
|
return n;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
static unsigned long u32_get(struct tcf_proto *tp, u32 handle)
|
|
|
|
{
|
|
|
|
struct tc_u_hnode *ht;
|
|
|
|
struct tc_u_common *tp_c = tp->data;
|
|
|
|
|
|
|
|
if (TC_U32_HTID(handle) == TC_U32_ROOT)
|
2014-09-13 11:09:16 +08:00
|
|
|
ht = rtnl_dereference(tp->root);
|
2005-04-17 06:20:36 +08:00
|
|
|
else
|
|
|
|
ht = u32_lookup_ht(tp_c, TC_U32_HTID(handle));
|
|
|
|
|
|
|
|
if (!ht)
|
|
|
|
return 0;
|
|
|
|
|
|
|
|
if (TC_U32_KEY(handle) == 0)
|
|
|
|
return (unsigned long)ht;
|
|
|
|
|
|
|
|
return (unsigned long)u32_lookup_key(ht, handle);
|
|
|
|
}
|
|
|
|
|
|
|
|
static u32 gen_new_htid(struct tc_u_common *tp_c)
|
|
|
|
{
|
|
|
|
int i = 0x800;
|
|
|
|
|
2014-09-13 11:09:16 +08:00
|
|
|
/* hgenerator only used inside rtnl lock it is safe to increment
|
|
|
|
* without read _copy_ update semantics
|
|
|
|
*/
|
2005-04-17 06:20:36 +08:00
|
|
|
do {
|
|
|
|
if (++tp_c->hgenerator == 0x7FF)
|
|
|
|
tp_c->hgenerator = 1;
|
2011-01-20 03:26:56 +08:00
|
|
|
} while (--i > 0 && u32_lookup_ht(tp_c, (tp_c->hgenerator|0x800)<<20));
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
return i > 0 ? (tp_c->hgenerator|0x800)<<20 : 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int u32_init(struct tcf_proto *tp)
|
|
|
|
{
|
|
|
|
struct tc_u_hnode *root_ht;
|
|
|
|
struct tc_u_common *tp_c;
|
|
|
|
|
2008-07-19 11:54:17 +08:00
|
|
|
tp_c = tp->q->u32_node;
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2006-07-22 05:51:30 +08:00
|
|
|
root_ht = kzalloc(sizeof(*root_ht), GFP_KERNEL);
|
2005-04-17 06:20:36 +08:00
|
|
|
if (root_ht == NULL)
|
|
|
|
return -ENOBUFS;
|
|
|
|
|
|
|
|
root_ht->refcnt++;
|
|
|
|
root_ht->handle = tp_c ? gen_new_htid(tp_c) : 0x80000000;
|
|
|
|
root_ht->prio = tp->prio;
|
|
|
|
|
|
|
|
if (tp_c == NULL) {
|
2006-07-22 05:51:30 +08:00
|
|
|
tp_c = kzalloc(sizeof(*tp_c), GFP_KERNEL);
|
2005-04-17 06:20:36 +08:00
|
|
|
if (tp_c == NULL) {
|
|
|
|
kfree(root_ht);
|
|
|
|
return -ENOBUFS;
|
|
|
|
}
|
|
|
|
tp_c->q = tp->q;
|
2008-07-19 11:54:17 +08:00
|
|
|
tp->q->u32_node = tp_c;
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
tp_c->refcnt++;
|
2014-09-13 11:09:16 +08:00
|
|
|
RCU_INIT_POINTER(root_ht->next, tp_c->hlist);
|
|
|
|
rcu_assign_pointer(tp_c->hlist, root_ht);
|
2005-04-17 06:20:36 +08:00
|
|
|
root_ht->tp_c = tp_c;
|
|
|
|
|
2014-09-13 11:09:16 +08:00
|
|
|
rcu_assign_pointer(tp->root, root_ht);
|
2005-04-17 06:20:36 +08:00
|
|
|
tp->data = tp_c;
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2016-09-18 20:45:33 +08:00
|
|
|
static int u32_destroy_key(struct tcf_proto *tp, struct tc_u_knode *n,
|
2014-09-20 12:50:34 +08:00
|
|
|
bool free_pf)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
2014-09-26 01:26:37 +08:00
|
|
|
tcf_exts_destroy(&n->exts);
|
2005-04-17 06:20:36 +08:00
|
|
|
if (n->ht_down)
|
|
|
|
n->ht_down->refcnt--;
|
|
|
|
#ifdef CONFIG_CLS_U32_PERF
|
2014-09-20 12:50:34 +08:00
|
|
|
if (free_pf)
|
|
|
|
free_percpu(n->pf);
|
2014-09-20 12:50:04 +08:00
|
|
|
#endif
|
|
|
|
#ifdef CONFIG_CLS_U32_MARK
|
2014-09-20 12:50:34 +08:00
|
|
|
if (free_pf)
|
|
|
|
free_percpu(n->pcpu_success);
|
2005-04-17 06:20:36 +08:00
|
|
|
#endif
|
|
|
|
kfree(n);
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2014-09-20 12:50:34 +08:00
|
|
|
/* u32_delete_key_rcu should be called when free'ing a copied
|
|
|
|
* version of a tc_u_knode obtained from u32_init_knode(). When
|
|
|
|
* copies are obtained from u32_init_knode() the statistics are
|
|
|
|
* shared between the old and new copies to allow readers to
|
|
|
|
* continue to update the statistics during the copy. To support
|
|
|
|
* this the u32_delete_key_rcu variant does not free the percpu
|
|
|
|
* statistics.
|
|
|
|
*/
|
2014-09-13 11:09:16 +08:00
|
|
|
static void u32_delete_key_rcu(struct rcu_head *rcu)
|
|
|
|
{
|
|
|
|
struct tc_u_knode *key = container_of(rcu, struct tc_u_knode, rcu);
|
|
|
|
|
2014-09-20 12:50:34 +08:00
|
|
|
u32_destroy_key(key->tp, key, false);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* u32_delete_key_freepf_rcu is the rcu callback variant
|
|
|
|
* that free's the entire structure including the statistics
|
|
|
|
* percpu variables. Only use this if the key is not a copy
|
|
|
|
* returned by u32_init_knode(). See u32_delete_key_rcu()
|
|
|
|
* for the variant that should be used with keys return from
|
|
|
|
* u32_init_knode()
|
|
|
|
*/
|
|
|
|
static void u32_delete_key_freepf_rcu(struct rcu_head *rcu)
|
|
|
|
{
|
|
|
|
struct tc_u_knode *key = container_of(rcu, struct tc_u_knode, rcu);
|
|
|
|
|
|
|
|
u32_destroy_key(key->tp, key, true);
|
2014-09-13 11:09:16 +08:00
|
|
|
}
|
|
|
|
|
2013-12-10 20:55:31 +08:00
|
|
|
static int u32_delete_key(struct tcf_proto *tp, struct tc_u_knode *key)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
2014-09-13 11:09:16 +08:00
|
|
|
struct tc_u_knode __rcu **kp;
|
|
|
|
struct tc_u_knode *pkp;
|
2014-09-16 14:30:49 +08:00
|
|
|
struct tc_u_hnode *ht = rtnl_dereference(key->ht_up);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
if (ht) {
|
2014-09-13 11:09:16 +08:00
|
|
|
kp = &ht->ht[TC_U32_HASH(key->handle)];
|
|
|
|
for (pkp = rtnl_dereference(*kp); pkp;
|
|
|
|
kp = &pkp->next, pkp = rtnl_dereference(*kp)) {
|
|
|
|
if (pkp == key) {
|
|
|
|
RCU_INIT_POINTER(*kp, key->next);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2014-10-01 07:07:24 +08:00
|
|
|
tcf_unbind_filter(tp, &key->res);
|
2014-09-20 12:50:34 +08:00
|
|
|
call_rcu(&key->rcu, u32_delete_key_freepf_rcu);
|
2005-04-17 06:20:36 +08:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
2008-07-26 12:43:18 +08:00
|
|
|
WARN_ON(1);
|
2005-04-17 06:20:36 +08:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2016-02-17 13:17:09 +08:00
|
|
|
static void u32_remove_hw_knode(struct tcf_proto *tp, u32 handle)
|
|
|
|
{
|
|
|
|
struct net_device *dev = tp->q->dev_queue->dev;
|
|
|
|
struct tc_cls_u32_offload u32_offload = {0};
|
|
|
|
struct tc_to_netdev offload;
|
|
|
|
|
|
|
|
offload.type = TC_SETUP_CLSU32;
|
|
|
|
offload.cls_u32 = &u32_offload;
|
|
|
|
|
2016-06-07 04:50:39 +08:00
|
|
|
if (tc_should_offload(dev, tp, 0)) {
|
2016-02-17 13:17:09 +08:00
|
|
|
offload.cls_u32->command = TC_CLSU32_DELETE_KNODE;
|
|
|
|
offload.cls_u32->knode.handle = handle;
|
|
|
|
dev->netdev_ops->ndo_setup_tc(dev, tp->q->handle,
|
|
|
|
tp->protocol, &offload);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2016-09-18 20:45:33 +08:00
|
|
|
static int u32_replace_hw_hnode(struct tcf_proto *tp, struct tc_u_hnode *h,
|
|
|
|
u32 flags)
|
2016-02-17 13:17:09 +08:00
|
|
|
{
|
|
|
|
struct net_device *dev = tp->q->dev_queue->dev;
|
|
|
|
struct tc_cls_u32_offload u32_offload = {0};
|
|
|
|
struct tc_to_netdev offload;
|
2016-05-13 08:08:23 +08:00
|
|
|
int err;
|
2016-02-17 13:17:09 +08:00
|
|
|
|
2016-06-07 04:50:39 +08:00
|
|
|
if (!tc_should_offload(dev, tp, flags))
|
2016-06-06 23:16:48 +08:00
|
|
|
return tc_skip_sw(flags) ? -EINVAL : 0;
|
|
|
|
|
2016-02-17 13:17:09 +08:00
|
|
|
offload.type = TC_SETUP_CLSU32;
|
|
|
|
offload.cls_u32 = &u32_offload;
|
|
|
|
|
2016-06-06 23:16:48 +08:00
|
|
|
offload.cls_u32->command = TC_CLSU32_NEW_HNODE;
|
|
|
|
offload.cls_u32->hnode.divisor = h->divisor;
|
|
|
|
offload.cls_u32->hnode.handle = h->handle;
|
|
|
|
offload.cls_u32->hnode.prio = h->prio;
|
2016-02-17 13:17:09 +08:00
|
|
|
|
2016-06-06 23:16:48 +08:00
|
|
|
err = dev->netdev_ops->ndo_setup_tc(dev, tp->q->handle,
|
|
|
|
tp->protocol, &offload);
|
|
|
|
if (tc_skip_sw(flags))
|
|
|
|
return err;
|
2016-05-13 08:08:23 +08:00
|
|
|
|
|
|
|
return 0;
|
2016-02-17 13:17:09 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
static void u32_clear_hw_hnode(struct tcf_proto *tp, struct tc_u_hnode *h)
|
|
|
|
{
|
|
|
|
struct net_device *dev = tp->q->dev_queue->dev;
|
|
|
|
struct tc_cls_u32_offload u32_offload = {0};
|
|
|
|
struct tc_to_netdev offload;
|
|
|
|
|
|
|
|
offload.type = TC_SETUP_CLSU32;
|
|
|
|
offload.cls_u32 = &u32_offload;
|
|
|
|
|
2016-06-07 04:50:39 +08:00
|
|
|
if (tc_should_offload(dev, tp, 0)) {
|
2016-02-17 13:17:09 +08:00
|
|
|
offload.cls_u32->command = TC_CLSU32_DELETE_HNODE;
|
|
|
|
offload.cls_u32->hnode.divisor = h->divisor;
|
|
|
|
offload.cls_u32->hnode.handle = h->handle;
|
|
|
|
offload.cls_u32->hnode.prio = h->prio;
|
|
|
|
|
|
|
|
dev->netdev_ops->ndo_setup_tc(dev, tp->q->handle,
|
|
|
|
tp->protocol, &offload);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2016-09-18 20:45:33 +08:00
|
|
|
static int u32_replace_hw_knode(struct tcf_proto *tp, struct tc_u_knode *n,
|
|
|
|
u32 flags)
|
2016-02-17 13:17:09 +08:00
|
|
|
{
|
|
|
|
struct net_device *dev = tp->q->dev_queue->dev;
|
|
|
|
struct tc_cls_u32_offload u32_offload = {0};
|
|
|
|
struct tc_to_netdev offload;
|
2016-05-13 08:08:23 +08:00
|
|
|
int err;
|
2016-02-17 13:17:09 +08:00
|
|
|
|
|
|
|
offload.type = TC_SETUP_CLSU32;
|
|
|
|
offload.cls_u32 = &u32_offload;
|
|
|
|
|
2016-06-09 03:11:04 +08:00
|
|
|
if (!tc_should_offload(dev, tp, flags))
|
|
|
|
return tc_skip_sw(flags) ? -EINVAL : 0;
|
|
|
|
|
|
|
|
offload.cls_u32->command = TC_CLSU32_REPLACE_KNODE;
|
|
|
|
offload.cls_u32->knode.handle = n->handle;
|
|
|
|
offload.cls_u32->knode.fshift = n->fshift;
|
2016-02-17 13:17:09 +08:00
|
|
|
#ifdef CONFIG_CLS_U32_MARK
|
2016-06-09 03:11:04 +08:00
|
|
|
offload.cls_u32->knode.val = n->val;
|
|
|
|
offload.cls_u32->knode.mask = n->mask;
|
2016-02-17 13:17:09 +08:00
|
|
|
#else
|
2016-06-09 03:11:04 +08:00
|
|
|
offload.cls_u32->knode.val = 0;
|
|
|
|
offload.cls_u32->knode.mask = 0;
|
2016-02-17 13:17:09 +08:00
|
|
|
#endif
|
2016-06-09 03:11:04 +08:00
|
|
|
offload.cls_u32->knode.sel = &n->sel;
|
|
|
|
offload.cls_u32->knode.exts = &n->exts;
|
|
|
|
if (n->ht_down)
|
|
|
|
offload.cls_u32->knode.link_handle = n->ht_down->handle;
|
|
|
|
|
|
|
|
err = dev->netdev_ops->ndo_setup_tc(dev, tp->q->handle,
|
|
|
|
tp->protocol, &offload);
|
2017-02-16 16:31:15 +08:00
|
|
|
|
|
|
|
if (!err)
|
|
|
|
n->flags |= TCA_CLS_FLAGS_IN_HW;
|
|
|
|
|
2016-06-09 03:11:04 +08:00
|
|
|
if (tc_skip_sw(flags))
|
|
|
|
return err;
|
2016-05-13 08:08:23 +08:00
|
|
|
|
|
|
|
return 0;
|
2016-02-17 13:17:09 +08:00
|
|
|
}
|
|
|
|
|
2014-10-01 07:07:24 +08:00
|
|
|
static void u32_clear_hnode(struct tcf_proto *tp, struct tc_u_hnode *ht)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
|
|
|
struct tc_u_knode *n;
|
2011-01-20 03:26:56 +08:00
|
|
|
unsigned int h;
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2011-01-20 03:26:56 +08:00
|
|
|
for (h = 0; h <= ht->divisor; h++) {
|
2014-09-13 11:09:16 +08:00
|
|
|
while ((n = rtnl_dereference(ht->ht[h])) != NULL) {
|
|
|
|
RCU_INIT_POINTER(ht->ht[h],
|
|
|
|
rtnl_dereference(n->next));
|
2014-10-01 07:07:24 +08:00
|
|
|
tcf_unbind_filter(tp, &n->res);
|
2016-02-17 13:17:09 +08:00
|
|
|
u32_remove_hw_knode(tp, n->handle);
|
2014-09-20 12:50:34 +08:00
|
|
|
call_rcu(&n->rcu, u32_delete_key_freepf_rcu);
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static int u32_destroy_hnode(struct tcf_proto *tp, struct tc_u_hnode *ht)
|
|
|
|
{
|
|
|
|
struct tc_u_common *tp_c = tp->data;
|
2014-09-13 11:09:16 +08:00
|
|
|
struct tc_u_hnode __rcu **hn;
|
|
|
|
struct tc_u_hnode *phn;
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2008-07-26 12:43:18 +08:00
|
|
|
WARN_ON(ht->refcnt);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2014-10-01 07:07:24 +08:00
|
|
|
u32_clear_hnode(tp, ht);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2014-09-13 11:09:16 +08:00
|
|
|
hn = &tp_c->hlist;
|
|
|
|
for (phn = rtnl_dereference(*hn);
|
|
|
|
phn;
|
|
|
|
hn = &phn->next, phn = rtnl_dereference(*hn)) {
|
|
|
|
if (phn == ht) {
|
2016-02-17 13:17:09 +08:00
|
|
|
u32_clear_hw_hnode(tp, ht);
|
2014-09-13 11:09:16 +08:00
|
|
|
RCU_INIT_POINTER(*hn, ht->next);
|
|
|
|
kfree_rcu(ht, rcu);
|
2005-04-17 06:20:36 +08:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
return -ENOENT;
|
|
|
|
}
|
|
|
|
|
2015-03-07 03:47:59 +08:00
|
|
|
static bool ht_empty(struct tc_u_hnode *ht)
|
|
|
|
{
|
|
|
|
unsigned int h;
|
|
|
|
|
|
|
|
for (h = 0; h <= ht->divisor; h++)
|
|
|
|
if (rcu_access_pointer(ht->ht[h]))
|
|
|
|
return false;
|
|
|
|
|
|
|
|
return true;
|
|
|
|
}
|
|
|
|
|
|
|
|
static bool u32_destroy(struct tcf_proto *tp, bool force)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
|
|
|
struct tc_u_common *tp_c = tp->data;
|
2014-09-13 11:09:16 +08:00
|
|
|
struct tc_u_hnode *root_ht = rtnl_dereference(tp->root);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2008-07-26 12:43:18 +08:00
|
|
|
WARN_ON(root_ht == NULL);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2015-03-07 03:47:59 +08:00
|
|
|
if (!force) {
|
|
|
|
if (root_ht) {
|
|
|
|
if (root_ht->refcnt > 1)
|
|
|
|
return false;
|
|
|
|
if (root_ht->refcnt == 1) {
|
|
|
|
if (!ht_empty(root_ht))
|
|
|
|
return false;
|
|
|
|
}
|
|
|
|
}
|
2015-08-26 07:38:12 +08:00
|
|
|
|
|
|
|
if (tp_c->refcnt > 1)
|
|
|
|
return false;
|
|
|
|
|
|
|
|
if (tp_c->refcnt == 1) {
|
|
|
|
struct tc_u_hnode *ht;
|
|
|
|
|
|
|
|
for (ht = rtnl_dereference(tp_c->hlist);
|
|
|
|
ht;
|
|
|
|
ht = rtnl_dereference(ht->next))
|
|
|
|
if (!ht_empty(ht))
|
|
|
|
return false;
|
|
|
|
}
|
2015-03-07 03:47:59 +08:00
|
|
|
}
|
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
if (root_ht && --root_ht->refcnt == 0)
|
|
|
|
u32_destroy_hnode(tp, root_ht);
|
|
|
|
|
|
|
|
if (--tp_c->refcnt == 0) {
|
|
|
|
struct tc_u_hnode *ht;
|
|
|
|
|
2008-07-19 11:54:17 +08:00
|
|
|
tp->q->u32_node = NULL;
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2014-09-13 11:09:16 +08:00
|
|
|
for (ht = rtnl_dereference(tp_c->hlist);
|
|
|
|
ht;
|
|
|
|
ht = rtnl_dereference(ht->next)) {
|
2008-04-13 09:37:13 +08:00
|
|
|
ht->refcnt--;
|
2014-10-01 07:07:24 +08:00
|
|
|
u32_clear_hnode(tp, ht);
|
2008-04-13 09:37:13 +08:00
|
|
|
}
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2014-09-13 11:09:16 +08:00
|
|
|
while ((ht = rtnl_dereference(tp_c->hlist)) != NULL) {
|
|
|
|
RCU_INIT_POINTER(tp_c->hlist, ht->next);
|
|
|
|
kfree_rcu(ht, rcu);
|
2007-04-21 08:09:22 +08:00
|
|
|
}
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
kfree(tp_c);
|
|
|
|
}
|
|
|
|
|
|
|
|
tp->data = NULL;
|
2015-03-07 03:47:59 +08:00
|
|
|
return true;
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
static int u32_delete(struct tcf_proto *tp, unsigned long arg)
|
|
|
|
{
|
2011-01-20 03:26:56 +08:00
|
|
|
struct tc_u_hnode *ht = (struct tc_u_hnode *)arg;
|
2014-09-13 11:09:16 +08:00
|
|
|
struct tc_u_hnode *root_ht = rtnl_dereference(tp->root);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
if (ht == NULL)
|
|
|
|
return 0;
|
|
|
|
|
2016-02-17 13:17:09 +08:00
|
|
|
if (TC_U32_KEY(ht->handle)) {
|
|
|
|
u32_remove_hw_knode(tp, ht->handle);
|
2011-01-20 03:26:56 +08:00
|
|
|
return u32_delete_key(tp, (struct tc_u_knode *)ht);
|
2016-02-17 13:17:09 +08:00
|
|
|
}
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2014-09-13 11:09:16 +08:00
|
|
|
if (root_ht == ht)
|
2005-04-17 06:20:36 +08:00
|
|
|
return -EINVAL;
|
|
|
|
|
2008-04-13 09:37:13 +08:00
|
|
|
if (ht->refcnt == 1) {
|
|
|
|
ht->refcnt--;
|
2005-04-17 06:20:36 +08:00
|
|
|
u32_destroy_hnode(tp, ht);
|
2008-04-13 09:37:13 +08:00
|
|
|
} else {
|
|
|
|
return -EBUSY;
|
|
|
|
}
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2014-07-18 08:34:53 +08:00
|
|
|
#define NR_U32_NODE (1<<12)
|
2005-04-17 06:20:36 +08:00
|
|
|
static u32 gen_new_kid(struct tc_u_hnode *ht, u32 handle)
|
|
|
|
{
|
|
|
|
struct tc_u_knode *n;
|
2014-07-18 08:34:53 +08:00
|
|
|
unsigned long i;
|
|
|
|
unsigned long *bitmap = kzalloc(BITS_TO_LONGS(NR_U32_NODE) * sizeof(unsigned long),
|
|
|
|
GFP_KERNEL);
|
|
|
|
if (!bitmap)
|
|
|
|
return handle | 0xFFF;
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2014-09-13 11:09:16 +08:00
|
|
|
for (n = rtnl_dereference(ht->ht[TC_U32_HASH(handle)]);
|
|
|
|
n;
|
|
|
|
n = rtnl_dereference(n->next))
|
2014-07-18 08:34:53 +08:00
|
|
|
set_bit(TC_U32_NODE(n->handle), bitmap);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2014-07-18 08:34:53 +08:00
|
|
|
i = find_next_zero_bit(bitmap, NR_U32_NODE, 0x800);
|
|
|
|
if (i >= NR_U32_NODE)
|
|
|
|
i = find_next_zero_bit(bitmap, NR_U32_NODE, 1);
|
|
|
|
|
|
|
|
kfree(bitmap);
|
|
|
|
return handle | (i >= NR_U32_NODE ? 0xFFF : i);
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
|
2008-01-24 12:36:12 +08:00
|
|
|
static const struct nla_policy u32_policy[TCA_U32_MAX + 1] = {
|
|
|
|
[TCA_U32_CLASSID] = { .type = NLA_U32 },
|
|
|
|
[TCA_U32_HASH] = { .type = NLA_U32 },
|
|
|
|
[TCA_U32_LINK] = { .type = NLA_U32 },
|
|
|
|
[TCA_U32_DIVISOR] = { .type = NLA_U32 },
|
|
|
|
[TCA_U32_SEL] = { .len = sizeof(struct tc_u32_sel) },
|
|
|
|
[TCA_U32_INDEV] = { .type = NLA_STRING, .len = IFNAMSIZ },
|
|
|
|
[TCA_U32_MARK] = { .len = sizeof(struct tc_u32_mark) },
|
2016-02-26 23:54:39 +08:00
|
|
|
[TCA_U32_FLAGS] = { .type = NLA_U32 },
|
2008-01-24 12:36:12 +08:00
|
|
|
};
|
|
|
|
|
2013-01-14 13:15:39 +08:00
|
|
|
static int u32_set_parms(struct net *net, struct tcf_proto *tp,
|
|
|
|
unsigned long base, struct tc_u_hnode *ht,
|
2008-01-23 14:11:33 +08:00
|
|
|
struct tc_u_knode *n, struct nlattr **tb,
|
2014-04-26 04:54:06 +08:00
|
|
|
struct nlattr *est, bool ovr)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
|
|
|
struct tcf_exts e;
|
2016-08-20 03:36:54 +08:00
|
|
|
int err;
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2016-08-20 03:36:54 +08:00
|
|
|
err = tcf_exts_init(&e, TCA_U32_ACT, TCA_U32_POLICE);
|
2005-04-17 06:20:36 +08:00
|
|
|
if (err < 0)
|
|
|
|
return err;
|
2016-08-20 03:36:54 +08:00
|
|
|
err = tcf_exts_validate(net, tp, tb, est, &e, ovr);
|
|
|
|
if (err < 0)
|
|
|
|
goto errout;
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
err = -EINVAL;
|
2008-01-23 14:11:33 +08:00
|
|
|
if (tb[TCA_U32_LINK]) {
|
2008-01-24 12:35:03 +08:00
|
|
|
u32 handle = nla_get_u32(tb[TCA_U32_LINK]);
|
2008-11-19 16:03:09 +08:00
|
|
|
struct tc_u_hnode *ht_down = NULL, *ht_old;
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
if (TC_U32_KEY(handle))
|
|
|
|
goto errout;
|
|
|
|
|
|
|
|
if (handle) {
|
|
|
|
ht_down = u32_lookup_ht(ht->tp_c, handle);
|
|
|
|
|
|
|
|
if (ht_down == NULL)
|
|
|
|
goto errout;
|
|
|
|
ht_down->refcnt++;
|
|
|
|
}
|
|
|
|
|
2014-09-13 11:09:16 +08:00
|
|
|
ht_old = rtnl_dereference(n->ht_down);
|
|
|
|
rcu_assign_pointer(n->ht_down, ht_down);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2008-11-19 16:03:09 +08:00
|
|
|
if (ht_old)
|
|
|
|
ht_old->refcnt--;
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
2008-01-23 14:11:33 +08:00
|
|
|
if (tb[TCA_U32_CLASSID]) {
|
2008-01-24 12:35:03 +08:00
|
|
|
n->res.classid = nla_get_u32(tb[TCA_U32_CLASSID]);
|
2005-04-17 06:20:36 +08:00
|
|
|
tcf_bind_filter(tp, &n->res, base);
|
|
|
|
}
|
|
|
|
|
|
|
|
#ifdef CONFIG_NET_CLS_IND
|
2008-01-23 14:11:33 +08:00
|
|
|
if (tb[TCA_U32_INDEV]) {
|
2014-01-10 08:14:02 +08:00
|
|
|
int ret;
|
|
|
|
ret = tcf_change_indev(net, tb[TCA_U32_INDEV]);
|
|
|
|
if (ret < 0)
|
2005-04-17 06:20:36 +08:00
|
|
|
goto errout;
|
2014-01-10 08:14:02 +08:00
|
|
|
n->ifindex = ret;
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
#endif
|
|
|
|
tcf_exts_change(tp, &n->exts, &e);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
errout:
|
2014-09-26 01:26:37 +08:00
|
|
|
tcf_exts_destroy(&e);
|
2005-04-17 06:20:36 +08:00
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2016-09-18 20:45:33 +08:00
|
|
|
static void u32_replace_knode(struct tcf_proto *tp, struct tc_u_common *tp_c,
|
2014-09-20 12:50:34 +08:00
|
|
|
struct tc_u_knode *n)
|
|
|
|
{
|
|
|
|
struct tc_u_knode __rcu **ins;
|
|
|
|
struct tc_u_knode *pins;
|
|
|
|
struct tc_u_hnode *ht;
|
|
|
|
|
|
|
|
if (TC_U32_HTID(n->handle) == TC_U32_ROOT)
|
|
|
|
ht = rtnl_dereference(tp->root);
|
|
|
|
else
|
|
|
|
ht = u32_lookup_ht(tp_c, TC_U32_HTID(n->handle));
|
|
|
|
|
|
|
|
ins = &ht->ht[TC_U32_HASH(n->handle)];
|
|
|
|
|
|
|
|
/* The node must always exist for it to be replaced if this is not the
|
|
|
|
* case then something went very wrong elsewhere.
|
|
|
|
*/
|
|
|
|
for (pins = rtnl_dereference(*ins); ;
|
|
|
|
ins = &pins->next, pins = rtnl_dereference(*ins))
|
|
|
|
if (pins->handle == n->handle)
|
|
|
|
break;
|
|
|
|
|
|
|
|
RCU_INIT_POINTER(n->next, pins->next);
|
|
|
|
rcu_assign_pointer(*ins, n);
|
|
|
|
}
|
|
|
|
|
|
|
|
static struct tc_u_knode *u32_init_knode(struct tcf_proto *tp,
|
|
|
|
struct tc_u_knode *n)
|
|
|
|
{
|
|
|
|
struct tc_u_knode *new;
|
|
|
|
struct tc_u32_sel *s = &n->sel;
|
|
|
|
|
|
|
|
new = kzalloc(sizeof(*n) + s->nkeys*sizeof(struct tc_u32_key),
|
|
|
|
GFP_KERNEL);
|
|
|
|
|
|
|
|
if (!new)
|
|
|
|
return NULL;
|
|
|
|
|
|
|
|
RCU_INIT_POINTER(new->next, n->next);
|
|
|
|
new->handle = n->handle;
|
|
|
|
RCU_INIT_POINTER(new->ht_up, n->ht_up);
|
|
|
|
|
|
|
|
#ifdef CONFIG_NET_CLS_IND
|
|
|
|
new->ifindex = n->ifindex;
|
|
|
|
#endif
|
|
|
|
new->fshift = n->fshift;
|
|
|
|
new->res = n->res;
|
2016-02-26 23:54:39 +08:00
|
|
|
new->flags = n->flags;
|
2014-09-20 12:50:34 +08:00
|
|
|
RCU_INIT_POINTER(new->ht_down, n->ht_down);
|
|
|
|
|
|
|
|
/* bump reference count as long as we hold pointer to structure */
|
|
|
|
if (new->ht_down)
|
|
|
|
new->ht_down->refcnt++;
|
|
|
|
|
|
|
|
#ifdef CONFIG_CLS_U32_PERF
|
|
|
|
/* Statistics may be incremented by readers during update
|
|
|
|
* so we must keep them in tact. When the node is later destroyed
|
|
|
|
* a special destroy call must be made to not free the pf memory.
|
|
|
|
*/
|
|
|
|
new->pf = n->pf;
|
|
|
|
#endif
|
|
|
|
|
|
|
|
#ifdef CONFIG_CLS_U32_MARK
|
|
|
|
new->val = n->val;
|
|
|
|
new->mask = n->mask;
|
|
|
|
/* Similarly success statistics must be moved as pointers */
|
|
|
|
new->pcpu_success = n->pcpu_success;
|
|
|
|
#endif
|
|
|
|
new->tp = tp;
|
|
|
|
memcpy(&new->sel, s, sizeof(*s) + s->nkeys*sizeof(struct tc_u32_key));
|
|
|
|
|
2016-08-20 03:36:54 +08:00
|
|
|
if (tcf_exts_init(&new->exts, TCA_U32_ACT, TCA_U32_POLICE)) {
|
|
|
|
kfree(new);
|
|
|
|
return NULL;
|
|
|
|
}
|
2014-09-20 12:50:34 +08:00
|
|
|
|
|
|
|
return new;
|
|
|
|
}
|
|
|
|
|
2013-01-14 13:15:39 +08:00
|
|
|
static int u32_change(struct net *net, struct sk_buff *in_skb,
|
2012-05-26 03:42:45 +08:00
|
|
|
struct tcf_proto *tp, unsigned long base, u32 handle,
|
2016-09-18 20:45:33 +08:00
|
|
|
struct nlattr **tca, unsigned long *arg, bool ovr)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
|
|
|
struct tc_u_common *tp_c = tp->data;
|
|
|
|
struct tc_u_hnode *ht;
|
|
|
|
struct tc_u_knode *n;
|
|
|
|
struct tc_u32_sel *s;
|
2008-01-23 14:11:33 +08:00
|
|
|
struct nlattr *opt = tca[TCA_OPTIONS];
|
|
|
|
struct nlattr *tb[TCA_U32_MAX + 1];
|
2016-02-26 23:54:39 +08:00
|
|
|
u32 htid, flags = 0;
|
2005-04-17 06:20:36 +08:00
|
|
|
int err;
|
2014-09-13 11:08:47 +08:00
|
|
|
#ifdef CONFIG_CLS_U32_PERF
|
|
|
|
size_t size;
|
|
|
|
#endif
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
if (opt == NULL)
|
|
|
|
return handle ? -EINVAL : 0;
|
|
|
|
|
2008-01-24 12:36:12 +08:00
|
|
|
err = nla_parse_nested(tb, TCA_U32_MAX, opt, u32_policy);
|
2008-01-24 12:33:32 +08:00
|
|
|
if (err < 0)
|
|
|
|
return err;
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2016-05-13 08:08:23 +08:00
|
|
|
if (tb[TCA_U32_FLAGS]) {
|
2016-02-26 23:54:39 +08:00
|
|
|
flags = nla_get_u32(tb[TCA_U32_FLAGS]);
|
2016-05-13 08:08:23 +08:00
|
|
|
if (!tc_flags_valid(flags))
|
2016-06-06 23:16:47 +08:00
|
|
|
return -EINVAL;
|
2016-05-13 08:08:23 +08:00
|
|
|
}
|
2016-02-26 23:54:39 +08:00
|
|
|
|
2011-01-20 03:26:56 +08:00
|
|
|
n = (struct tc_u_knode *)*arg;
|
|
|
|
if (n) {
|
2014-09-20 12:50:34 +08:00
|
|
|
struct tc_u_knode *new;
|
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
if (TC_U32_KEY(n->handle) == 0)
|
|
|
|
return -EINVAL;
|
|
|
|
|
2016-02-26 23:54:39 +08:00
|
|
|
if (n->flags != flags)
|
|
|
|
return -EINVAL;
|
|
|
|
|
2014-09-20 12:50:34 +08:00
|
|
|
new = u32_init_knode(tp, n);
|
|
|
|
if (!new)
|
|
|
|
return -ENOMEM;
|
|
|
|
|
|
|
|
err = u32_set_parms(net, tp, base,
|
|
|
|
rtnl_dereference(n->ht_up), new, tb,
|
|
|
|
tca[TCA_RATE], ovr);
|
|
|
|
|
|
|
|
if (err) {
|
|
|
|
u32_destroy_key(tp, new, false);
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2016-05-13 08:08:23 +08:00
|
|
|
err = u32_replace_hw_knode(tp, new, flags);
|
|
|
|
if (err) {
|
|
|
|
u32_destroy_key(tp, new, false);
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2017-02-16 16:31:15 +08:00
|
|
|
if (!tc_in_hw(new->flags))
|
|
|
|
new->flags |= TCA_CLS_FLAGS_NOT_IN_HW;
|
|
|
|
|
2014-09-20 12:50:34 +08:00
|
|
|
u32_replace_knode(tp, tp_c, new);
|
2014-10-01 07:07:24 +08:00
|
|
|
tcf_unbind_filter(tp, &n->res);
|
2014-09-20 12:50:34 +08:00
|
|
|
call_rcu(&n->rcu, u32_delete_key_rcu);
|
|
|
|
return 0;
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
|
2008-01-23 14:11:33 +08:00
|
|
|
if (tb[TCA_U32_DIVISOR]) {
|
2011-01-20 03:26:56 +08:00
|
|
|
unsigned int divisor = nla_get_u32(tb[TCA_U32_DIVISOR]);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
if (--divisor > 0x100)
|
|
|
|
return -EINVAL;
|
|
|
|
if (TC_U32_KEY(handle))
|
|
|
|
return -EINVAL;
|
|
|
|
if (handle == 0) {
|
|
|
|
handle = gen_new_htid(tp->data);
|
|
|
|
if (handle == 0)
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
2011-01-20 03:26:56 +08:00
|
|
|
ht = kzalloc(sizeof(*ht) + divisor*sizeof(void *), GFP_KERNEL);
|
2005-04-17 06:20:36 +08:00
|
|
|
if (ht == NULL)
|
|
|
|
return -ENOBUFS;
|
|
|
|
ht->tp_c = tp_c;
|
2008-04-13 09:37:13 +08:00
|
|
|
ht->refcnt = 1;
|
2005-04-17 06:20:36 +08:00
|
|
|
ht->divisor = divisor;
|
|
|
|
ht->handle = handle;
|
|
|
|
ht->prio = tp->prio;
|
2016-06-09 03:11:03 +08:00
|
|
|
|
|
|
|
err = u32_replace_hw_hnode(tp, ht, flags);
|
|
|
|
if (err) {
|
|
|
|
kfree(ht);
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2014-09-13 11:09:16 +08:00
|
|
|
RCU_INIT_POINTER(ht->next, tp_c->hlist);
|
|
|
|
rcu_assign_pointer(tp_c->hlist, ht);
|
2005-04-17 06:20:36 +08:00
|
|
|
*arg = (unsigned long)ht;
|
2016-02-17 13:17:09 +08:00
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2008-01-23 14:11:33 +08:00
|
|
|
if (tb[TCA_U32_HASH]) {
|
2008-01-24 12:35:03 +08:00
|
|
|
htid = nla_get_u32(tb[TCA_U32_HASH]);
|
2005-04-17 06:20:36 +08:00
|
|
|
if (TC_U32_HTID(htid) == TC_U32_ROOT) {
|
2014-09-13 11:09:16 +08:00
|
|
|
ht = rtnl_dereference(tp->root);
|
2005-04-17 06:20:36 +08:00
|
|
|
htid = ht->handle;
|
|
|
|
} else {
|
|
|
|
ht = u32_lookup_ht(tp->data, TC_U32_HTID(htid));
|
|
|
|
if (ht == NULL)
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
} else {
|
2014-09-13 11:09:16 +08:00
|
|
|
ht = rtnl_dereference(tp->root);
|
2005-04-17 06:20:36 +08:00
|
|
|
htid = ht->handle;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (ht->divisor < TC_U32_HASH(htid))
|
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
if (handle) {
|
|
|
|
if (TC_U32_HTID(handle) && TC_U32_HTID(handle^htid))
|
|
|
|
return -EINVAL;
|
|
|
|
handle = htid | TC_U32_NODE(handle);
|
|
|
|
} else
|
|
|
|
handle = gen_new_kid(ht, htid);
|
|
|
|
|
2008-01-24 12:36:12 +08:00
|
|
|
if (tb[TCA_U32_SEL] == NULL)
|
2005-04-17 06:20:36 +08:00
|
|
|
return -EINVAL;
|
|
|
|
|
2008-01-23 14:11:33 +08:00
|
|
|
s = nla_data(tb[TCA_U32_SEL]);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2006-07-22 05:51:30 +08:00
|
|
|
n = kzalloc(sizeof(*n) + s->nkeys*sizeof(struct tc_u32_key), GFP_KERNEL);
|
2005-04-17 06:20:36 +08:00
|
|
|
if (n == NULL)
|
|
|
|
return -ENOBUFS;
|
|
|
|
|
|
|
|
#ifdef CONFIG_CLS_U32_PERF
|
2014-09-13 11:08:47 +08:00
|
|
|
size = sizeof(struct tc_u32_pcnt) + s->nkeys * sizeof(u64);
|
|
|
|
n->pf = __alloc_percpu(size, __alignof__(struct tc_u32_pcnt));
|
|
|
|
if (!n->pf) {
|
2005-04-17 06:20:36 +08:00
|
|
|
kfree(n);
|
|
|
|
return -ENOBUFS;
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
|
|
|
memcpy(&n->sel, s, sizeof(*s) + s->nkeys*sizeof(struct tc_u32_key));
|
2014-09-16 14:30:49 +08:00
|
|
|
RCU_INIT_POINTER(n->ht_up, ht);
|
2005-04-17 06:20:36 +08:00
|
|
|
n->handle = handle;
|
2007-11-11 13:54:50 +08:00
|
|
|
n->fshift = s->hmask ? ffs(ntohl(s->hmask)) - 1 : 0;
|
2016-02-26 23:54:39 +08:00
|
|
|
n->flags = flags;
|
2014-09-13 11:09:16 +08:00
|
|
|
n->tp = tp;
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2016-08-20 03:36:54 +08:00
|
|
|
err = tcf_exts_init(&n->exts, TCA_U32_ACT, TCA_U32_POLICE);
|
|
|
|
if (err < 0)
|
|
|
|
goto errout;
|
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
#ifdef CONFIG_CLS_U32_MARK
|
2014-09-13 11:08:47 +08:00
|
|
|
n->pcpu_success = alloc_percpu(u32);
|
2014-09-20 12:50:04 +08:00
|
|
|
if (!n->pcpu_success) {
|
|
|
|
err = -ENOMEM;
|
|
|
|
goto errout;
|
|
|
|
}
|
2014-09-13 11:08:47 +08:00
|
|
|
|
2008-01-23 14:11:33 +08:00
|
|
|
if (tb[TCA_U32_MARK]) {
|
2005-04-17 06:20:36 +08:00
|
|
|
struct tc_u32_mark *mark;
|
|
|
|
|
2008-01-23 14:11:33 +08:00
|
|
|
mark = nla_data(tb[TCA_U32_MARK]);
|
2014-09-13 11:08:47 +08:00
|
|
|
n->val = mark->val;
|
|
|
|
n->mask = mark->mask;
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
2014-04-26 04:54:06 +08:00
|
|
|
err = u32_set_parms(net, tp, base, ht, n, tb, tca[TCA_RATE], ovr);
|
2005-04-17 06:20:36 +08:00
|
|
|
if (err == 0) {
|
2014-09-13 11:09:16 +08:00
|
|
|
struct tc_u_knode __rcu **ins;
|
|
|
|
struct tc_u_knode *pins;
|
|
|
|
|
2016-05-13 08:08:23 +08:00
|
|
|
err = u32_replace_hw_knode(tp, n, flags);
|
|
|
|
if (err)
|
|
|
|
goto errhw;
|
|
|
|
|
2017-02-16 16:31:15 +08:00
|
|
|
if (!tc_in_hw(n->flags))
|
|
|
|
n->flags |= TCA_CLS_FLAGS_NOT_IN_HW;
|
|
|
|
|
2014-09-13 11:09:16 +08:00
|
|
|
ins = &ht->ht[TC_U32_HASH(handle)];
|
|
|
|
for (pins = rtnl_dereference(*ins); pins;
|
|
|
|
ins = &pins->next, pins = rtnl_dereference(*ins))
|
|
|
|
if (TC_U32_NODE(handle) < TC_U32_NODE(pins->handle))
|
2005-04-17 06:20:36 +08:00
|
|
|
break;
|
|
|
|
|
2014-09-13 11:09:16 +08:00
|
|
|
RCU_INIT_POINTER(n->next, pins);
|
|
|
|
rcu_assign_pointer(*ins, n);
|
2005-04-17 06:20:36 +08:00
|
|
|
*arg = (unsigned long)n;
|
|
|
|
return 0;
|
|
|
|
}
|
2014-09-20 12:50:04 +08:00
|
|
|
|
2016-05-13 08:08:23 +08:00
|
|
|
errhw:
|
2014-09-20 12:50:04 +08:00
|
|
|
#ifdef CONFIG_CLS_U32_MARK
|
|
|
|
free_percpu(n->pcpu_success);
|
|
|
|
#endif
|
|
|
|
|
2016-08-20 03:36:54 +08:00
|
|
|
errout:
|
|
|
|
tcf_exts_destroy(&n->exts);
|
2005-04-17 06:20:36 +08:00
|
|
|
#ifdef CONFIG_CLS_U32_PERF
|
2014-09-13 11:09:16 +08:00
|
|
|
free_percpu(n->pf);
|
2005-04-17 06:20:36 +08:00
|
|
|
#endif
|
|
|
|
kfree(n);
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void u32_walk(struct tcf_proto *tp, struct tcf_walker *arg)
|
|
|
|
{
|
|
|
|
struct tc_u_common *tp_c = tp->data;
|
|
|
|
struct tc_u_hnode *ht;
|
|
|
|
struct tc_u_knode *n;
|
2011-01-20 03:26:56 +08:00
|
|
|
unsigned int h;
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
if (arg->stop)
|
|
|
|
return;
|
|
|
|
|
2014-09-13 11:09:16 +08:00
|
|
|
for (ht = rtnl_dereference(tp_c->hlist);
|
|
|
|
ht;
|
|
|
|
ht = rtnl_dereference(ht->next)) {
|
2005-04-17 06:20:36 +08:00
|
|
|
if (ht->prio != tp->prio)
|
|
|
|
continue;
|
|
|
|
if (arg->count >= arg->skip) {
|
|
|
|
if (arg->fn(tp, (unsigned long)ht, arg) < 0) {
|
|
|
|
arg->stop = 1;
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
arg->count++;
|
|
|
|
for (h = 0; h <= ht->divisor; h++) {
|
2014-09-13 11:09:16 +08:00
|
|
|
for (n = rtnl_dereference(ht->ht[h]);
|
|
|
|
n;
|
|
|
|
n = rtnl_dereference(n->next)) {
|
2005-04-17 06:20:36 +08:00
|
|
|
if (arg->count < arg->skip) {
|
|
|
|
arg->count++;
|
|
|
|
continue;
|
|
|
|
}
|
|
|
|
if (arg->fn(tp, (unsigned long)n, arg) < 0) {
|
|
|
|
arg->stop = 1;
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
arg->count++;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2014-01-10 08:14:01 +08:00
|
|
|
static int u32_dump(struct net *net, struct tcf_proto *tp, unsigned long fh,
|
2016-09-18 20:45:33 +08:00
|
|
|
struct sk_buff *skb, struct tcmsg *t)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
2011-01-20 03:26:56 +08:00
|
|
|
struct tc_u_knode *n = (struct tc_u_knode *)fh;
|
2014-09-13 11:09:16 +08:00
|
|
|
struct tc_u_hnode *ht_up, *ht_down;
|
2008-01-24 12:34:11 +08:00
|
|
|
struct nlattr *nest;
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
if (n == NULL)
|
|
|
|
return skb->len;
|
|
|
|
|
|
|
|
t->tcm_handle = n->handle;
|
|
|
|
|
2008-01-24 12:34:11 +08:00
|
|
|
nest = nla_nest_start(skb, TCA_OPTIONS);
|
|
|
|
if (nest == NULL)
|
|
|
|
goto nla_put_failure;
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
if (TC_U32_KEY(n->handle) == 0) {
|
2011-01-20 03:26:56 +08:00
|
|
|
struct tc_u_hnode *ht = (struct tc_u_hnode *)fh;
|
|
|
|
u32 divisor = ht->divisor + 1;
|
|
|
|
|
2012-03-29 17:11:39 +08:00
|
|
|
if (nla_put_u32(skb, TCA_U32_DIVISOR, divisor))
|
|
|
|
goto nla_put_failure;
|
2005-04-17 06:20:36 +08:00
|
|
|
} else {
|
2014-09-13 11:08:47 +08:00
|
|
|
#ifdef CONFIG_CLS_U32_PERF
|
|
|
|
struct tc_u32_pcnt *gpf;
|
|
|
|
int cpu;
|
2014-09-16 14:30:26 +08:00
|
|
|
#endif
|
2014-09-13 11:08:47 +08:00
|
|
|
|
2012-03-29 17:11:39 +08:00
|
|
|
if (nla_put(skb, TCA_U32_SEL,
|
|
|
|
sizeof(n->sel) + n->sel.nkeys*sizeof(struct tc_u32_key),
|
|
|
|
&n->sel))
|
|
|
|
goto nla_put_failure;
|
2014-09-13 11:09:16 +08:00
|
|
|
|
|
|
|
ht_up = rtnl_dereference(n->ht_up);
|
|
|
|
if (ht_up) {
|
2005-04-17 06:20:36 +08:00
|
|
|
u32 htid = n->handle & 0xFFFFF000;
|
2012-03-29 17:11:39 +08:00
|
|
|
if (nla_put_u32(skb, TCA_U32_HASH, htid))
|
|
|
|
goto nla_put_failure;
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
2012-03-29 17:11:39 +08:00
|
|
|
if (n->res.classid &&
|
|
|
|
nla_put_u32(skb, TCA_U32_CLASSID, n->res.classid))
|
|
|
|
goto nla_put_failure;
|
2014-09-13 11:09:16 +08:00
|
|
|
|
|
|
|
ht_down = rtnl_dereference(n->ht_down);
|
|
|
|
if (ht_down &&
|
|
|
|
nla_put_u32(skb, TCA_U32_LINK, ht_down->handle))
|
2012-03-29 17:11:39 +08:00
|
|
|
goto nla_put_failure;
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2016-02-26 23:54:39 +08:00
|
|
|
if (n->flags && nla_put_u32(skb, TCA_U32_FLAGS, n->flags))
|
|
|
|
goto nla_put_failure;
|
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
#ifdef CONFIG_CLS_U32_MARK
|
2014-09-13 11:08:47 +08:00
|
|
|
if ((n->val || n->mask)) {
|
|
|
|
struct tc_u32_mark mark = {.val = n->val,
|
|
|
|
.mask = n->mask,
|
|
|
|
.success = 0};
|
2014-09-16 14:30:26 +08:00
|
|
|
int cpum;
|
2014-09-13 11:08:47 +08:00
|
|
|
|
2014-09-16 14:30:26 +08:00
|
|
|
for_each_possible_cpu(cpum) {
|
|
|
|
__u32 cnt = *per_cpu_ptr(n->pcpu_success, cpum);
|
2014-09-13 11:08:47 +08:00
|
|
|
|
|
|
|
mark.success += cnt;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (nla_put(skb, TCA_U32_MARK, sizeof(mark), &mark))
|
|
|
|
goto nla_put_failure;
|
|
|
|
}
|
2005-04-17 06:20:36 +08:00
|
|
|
#endif
|
|
|
|
|
2013-12-16 12:15:07 +08:00
|
|
|
if (tcf_exts_dump(skb, &n->exts) < 0)
|
2008-01-23 14:11:33 +08:00
|
|
|
goto nla_put_failure;
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
#ifdef CONFIG_NET_CLS_IND
|
2014-01-10 08:14:02 +08:00
|
|
|
if (n->ifindex) {
|
|
|
|
struct net_device *dev;
|
|
|
|
dev = __dev_get_by_index(net, n->ifindex);
|
|
|
|
if (dev && nla_put_string(skb, TCA_U32_INDEV, dev->name))
|
|
|
|
goto nla_put_failure;
|
|
|
|
}
|
2005-04-17 06:20:36 +08:00
|
|
|
#endif
|
|
|
|
#ifdef CONFIG_CLS_U32_PERF
|
2014-09-13 11:08:47 +08:00
|
|
|
gpf = kzalloc(sizeof(struct tc_u32_pcnt) +
|
|
|
|
n->sel.nkeys * sizeof(u64),
|
|
|
|
GFP_KERNEL);
|
|
|
|
if (!gpf)
|
|
|
|
goto nla_put_failure;
|
|
|
|
|
|
|
|
for_each_possible_cpu(cpu) {
|
|
|
|
int i;
|
|
|
|
struct tc_u32_pcnt *pf = per_cpu_ptr(n->pf, cpu);
|
|
|
|
|
|
|
|
gpf->rcnt += pf->rcnt;
|
|
|
|
gpf->rhit += pf->rhit;
|
|
|
|
for (i = 0; i < n->sel.nkeys; i++)
|
|
|
|
gpf->kcnts[i] += pf->kcnts[i];
|
|
|
|
}
|
|
|
|
|
2016-04-26 16:06:18 +08:00
|
|
|
if (nla_put_64bit(skb, TCA_U32_PCNT,
|
|
|
|
sizeof(struct tc_u32_pcnt) +
|
|
|
|
n->sel.nkeys * sizeof(u64),
|
|
|
|
gpf, TCA_U32_PAD)) {
|
2014-09-13 11:08:47 +08:00
|
|
|
kfree(gpf);
|
2012-03-29 17:11:39 +08:00
|
|
|
goto nla_put_failure;
|
2014-09-13 11:08:47 +08:00
|
|
|
}
|
|
|
|
kfree(gpf);
|
2005-04-17 06:20:36 +08:00
|
|
|
#endif
|
|
|
|
}
|
|
|
|
|
2008-01-24 12:34:11 +08:00
|
|
|
nla_nest_end(skb, nest);
|
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
if (TC_U32_KEY(n->handle))
|
2013-12-16 12:15:07 +08:00
|
|
|
if (tcf_exts_dump_stats(skb, &n->exts) < 0)
|
2008-01-23 14:11:33 +08:00
|
|
|
goto nla_put_failure;
|
2005-04-17 06:20:36 +08:00
|
|
|
return skb->len;
|
|
|
|
|
2008-01-23 14:11:33 +08:00
|
|
|
nla_put_failure:
|
2008-01-24 12:34:11 +08:00
|
|
|
nla_nest_cancel(skb, nest);
|
2005-04-17 06:20:36 +08:00
|
|
|
return -1;
|
|
|
|
}
|
|
|
|
|
2008-01-23 14:10:42 +08:00
|
|
|
static struct tcf_proto_ops cls_u32_ops __read_mostly = {
|
2005-04-17 06:20:36 +08:00
|
|
|
.kind = "u32",
|
|
|
|
.classify = u32_classify,
|
|
|
|
.init = u32_init,
|
|
|
|
.destroy = u32_destroy,
|
|
|
|
.get = u32_get,
|
|
|
|
.change = u32_change,
|
|
|
|
.delete = u32_delete,
|
|
|
|
.walk = u32_walk,
|
|
|
|
.dump = u32_dump,
|
|
|
|
.owner = THIS_MODULE,
|
|
|
|
};
|
|
|
|
|
|
|
|
static int __init init_u32(void)
|
|
|
|
{
|
2010-05-12 14:37:05 +08:00
|
|
|
pr_info("u32 classifier\n");
|
2005-04-17 06:20:36 +08:00
|
|
|
#ifdef CONFIG_CLS_U32_PERF
|
2010-05-12 14:37:05 +08:00
|
|
|
pr_info(" Performance counters on\n");
|
2005-04-17 06:20:36 +08:00
|
|
|
#endif
|
|
|
|
#ifdef CONFIG_NET_CLS_IND
|
2010-05-12 14:37:05 +08:00
|
|
|
pr_info(" input device check on\n");
|
2005-04-17 06:20:36 +08:00
|
|
|
#endif
|
|
|
|
#ifdef CONFIG_NET_CLS_ACT
|
2010-05-12 14:37:05 +08:00
|
|
|
pr_info(" Actions configured\n");
|
2005-04-17 06:20:36 +08:00
|
|
|
#endif
|
|
|
|
return register_tcf_proto_ops(&cls_u32_ops);
|
|
|
|
}
|
|
|
|
|
2007-02-09 22:25:16 +08:00
|
|
|
static void __exit exit_u32(void)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
|
|
|
unregister_tcf_proto_ops(&cls_u32_ops);
|
|
|
|
}
|
|
|
|
|
|
|
|
module_init(init_u32)
|
|
|
|
module_exit(exit_u32)
|
|
|
|
MODULE_LICENSE("GPL");
|