2005-04-16 22:20:36 +00:00
|
|
|
/*
|
|
|
|
* net/sched/cls_rsvp.h Template file for RSVPv[46] classifiers.
|
|
|
|
*
|
|
|
|
* 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>
|
|
|
|
*/
|
|
|
|
|
|
|
|
/*
|
|
|
|
Comparing to general packet classification problem,
|
|
|
|
RSVP needs only sevaral relatively simple rules:
|
|
|
|
|
|
|
|
* (dst, protocol) are always specified,
|
|
|
|
so that we are able to hash them.
|
|
|
|
* src may be exact, or may be wildcard, so that
|
|
|
|
we can keep a hash table plus one wildcard entry.
|
|
|
|
* source port (or flow label) is important only if src is given.
|
|
|
|
|
|
|
|
IMPLEMENTATION.
|
|
|
|
|
|
|
|
We use a two level hash table: The top level is keyed by
|
|
|
|
destination address and protocol ID, every bucket contains a list
|
|
|
|
of "rsvp sessions", identified by destination address, protocol and
|
|
|
|
DPI(="Destination Port ID"): triple (key, mask, offset).
|
|
|
|
|
|
|
|
Every bucket has a smaller hash table keyed by source address
|
|
|
|
(cf. RSVP flowspec) and one wildcard entry for wildcard reservations.
|
|
|
|
Every bucket is again a list of "RSVP flows", selected by
|
|
|
|
source address and SPI(="Source Port ID" here rather than
|
|
|
|
"security parameter index"): triple (key, mask, offset).
|
|
|
|
|
|
|
|
|
|
|
|
NOTE 1. All the packets with IPv6 extension headers (but AH and ESP)
|
|
|
|
and all fragmented packets go to the best-effort traffic class.
|
|
|
|
|
|
|
|
|
|
|
|
NOTE 2. Two "port id"'s seems to be redundant, rfc2207 requires
|
|
|
|
only one "Generalized Port Identifier". So that for classic
|
|
|
|
ah, esp (and udp,tcp) both *pi should coincide or one of them
|
|
|
|
should be wildcard.
|
|
|
|
|
|
|
|
At first sight, this redundancy is just a waste of CPU
|
|
|
|
resources. But DPI and SPI add the possibility to assign different
|
|
|
|
priorities to GPIs. Look also at note 4 about tunnels below.
|
|
|
|
|
|
|
|
|
|
|
|
NOTE 3. One complication is the case of tunneled packets.
|
|
|
|
We implement it as following: if the first lookup
|
|
|
|
matches a special session with "tunnelhdr" value not zero,
|
|
|
|
flowid doesn't contain the true flow ID, but the tunnel ID (1...255).
|
|
|
|
In this case, we pull tunnelhdr bytes and restart lookup
|
|
|
|
with tunnel ID added to the list of keys. Simple and stupid 8)8)
|
|
|
|
It's enough for PIMREG and IPIP.
|
|
|
|
|
|
|
|
|
|
|
|
NOTE 4. Two GPIs make it possible to parse even GRE packets.
|
|
|
|
F.e. DPI can select ETH_P_IP (and necessary flags to make
|
|
|
|
tunnelhdr correct) in GRE protocol field and SPI matches
|
|
|
|
GRE key. Is it not nice? 8)8)
|
|
|
|
|
|
|
|
|
|
|
|
Well, as result, despite its simplicity, we get a pretty
|
|
|
|
powerful classification engine. */
|
|
|
|
|
|
|
|
|
|
|
|
struct rsvp_head
|
|
|
|
{
|
|
|
|
u32 tmap[256/32];
|
|
|
|
u32 hgenerator;
|
|
|
|
u8 tgenerator;
|
|
|
|
struct rsvp_session *ht[256];
|
|
|
|
};
|
|
|
|
|
|
|
|
struct rsvp_session
|
|
|
|
{
|
|
|
|
struct rsvp_session *next;
|
2006-11-21 02:07:51 +00:00
|
|
|
__be32 dst[RSVP_DST_LEN];
|
2005-04-16 22:20:36 +00:00
|
|
|
struct tc_rsvp_gpi dpi;
|
|
|
|
u8 protocol;
|
|
|
|
u8 tunnelid;
|
|
|
|
/* 16 (src,sport) hash slots, and one wildcard source slot */
|
|
|
|
struct rsvp_filter *ht[16+1];
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
|
|
struct rsvp_filter
|
|
|
|
{
|
|
|
|
struct rsvp_filter *next;
|
2006-11-21 02:07:51 +00:00
|
|
|
__be32 src[RSVP_DST_LEN];
|
2005-04-16 22:20:36 +00:00
|
|
|
struct tc_rsvp_gpi spi;
|
|
|
|
u8 tunnelhdr;
|
|
|
|
|
|
|
|
struct tcf_result res;
|
|
|
|
struct tcf_exts exts;
|
|
|
|
|
|
|
|
u32 handle;
|
|
|
|
struct rsvp_session *sess;
|
|
|
|
};
|
|
|
|
|
2006-11-21 02:07:51 +00:00
|
|
|
static __inline__ unsigned hash_dst(__be32 *dst, u8 protocol, u8 tunnelid)
|
2005-04-16 22:20:36 +00:00
|
|
|
{
|
2006-11-21 02:07:51 +00:00
|
|
|
unsigned h = (__force __u32)dst[RSVP_DST_LEN-1];
|
2005-04-16 22:20:36 +00:00
|
|
|
h ^= h>>16;
|
|
|
|
h ^= h>>8;
|
|
|
|
return (h ^ protocol ^ tunnelid) & 0xFF;
|
|
|
|
}
|
|
|
|
|
2006-11-21 02:07:51 +00:00
|
|
|
static __inline__ unsigned hash_src(__be32 *src)
|
2005-04-16 22:20:36 +00:00
|
|
|
{
|
2006-11-21 02:07:51 +00:00
|
|
|
unsigned h = (__force __u32)src[RSVP_DST_LEN-1];
|
2005-04-16 22:20:36 +00:00
|
|
|
h ^= h>>16;
|
|
|
|
h ^= h>>8;
|
|
|
|
h ^= h>>4;
|
|
|
|
return h & 0xF;
|
|
|
|
}
|
|
|
|
|
|
|
|
static struct tcf_ext_map rsvp_ext_map = {
|
|
|
|
.police = TCA_RSVP_POLICE,
|
|
|
|
.action = TCA_RSVP_ACT
|
|
|
|
};
|
|
|
|
|
|
|
|
#define RSVP_APPLY_RESULT() \
|
|
|
|
{ \
|
|
|
|
int r = tcf_exts_exec(skb, &f->exts, res); \
|
|
|
|
if (r < 0) \
|
|
|
|
continue; \
|
|
|
|
else if (r > 0) \
|
|
|
|
return r; \
|
|
|
|
}
|
2007-02-09 14:25:16 +00:00
|
|
|
|
2005-04-16 22:20:36 +00:00
|
|
|
static int rsvp_classify(struct sk_buff *skb, struct tcf_proto *tp,
|
|
|
|
struct tcf_result *res)
|
|
|
|
{
|
|
|
|
struct rsvp_session **sht = ((struct rsvp_head*)tp->root)->ht;
|
|
|
|
struct rsvp_session *s;
|
|
|
|
struct rsvp_filter *f;
|
|
|
|
unsigned h1, h2;
|
2006-11-21 02:07:51 +00:00
|
|
|
__be32 *dst, *src;
|
2005-04-16 22:20:36 +00:00
|
|
|
u8 protocol;
|
|
|
|
u8 tunnelid = 0;
|
|
|
|
u8 *xprt;
|
|
|
|
#if RSVP_DST_LEN == 4
|
2010-08-04 04:55:40 +00:00
|
|
|
struct ipv6hdr *nhptr;
|
|
|
|
|
|
|
|
if (!pskb_network_may_pull(skb, sizeof(*nhptr)))
|
|
|
|
return -1;
|
|
|
|
nhptr = ipv6_hdr(skb);
|
2005-04-16 22:20:36 +00:00
|
|
|
#else
|
2010-08-04 04:55:40 +00:00
|
|
|
struct iphdr *nhptr;
|
|
|
|
|
|
|
|
if (!pskb_network_may_pull(skb, sizeof(*nhptr)))
|
|
|
|
return -1;
|
|
|
|
nhptr = ip_hdr(skb);
|
2005-04-16 22:20:36 +00:00
|
|
|
#endif
|
|
|
|
|
|
|
|
restart:
|
|
|
|
|
|
|
|
#if RSVP_DST_LEN == 4
|
|
|
|
src = &nhptr->saddr.s6_addr32[0];
|
|
|
|
dst = &nhptr->daddr.s6_addr32[0];
|
|
|
|
protocol = nhptr->nexthdr;
|
|
|
|
xprt = ((u8*)nhptr) + sizeof(struct ipv6hdr);
|
|
|
|
#else
|
|
|
|
src = &nhptr->saddr;
|
|
|
|
dst = &nhptr->daddr;
|
|
|
|
protocol = nhptr->protocol;
|
|
|
|
xprt = ((u8*)nhptr) + (nhptr->ihl<<2);
|
2007-03-07 05:21:20 +00:00
|
|
|
if (nhptr->frag_off & htons(IP_MF|IP_OFFSET))
|
2005-04-16 22:20:36 +00:00
|
|
|
return -1;
|
|
|
|
#endif
|
|
|
|
|
|
|
|
h1 = hash_dst(dst, protocol, tunnelid);
|
|
|
|
h2 = hash_src(src);
|
|
|
|
|
|
|
|
for (s = sht[h1]; s; s = s->next) {
|
|
|
|
if (dst[RSVP_DST_LEN-1] == s->dst[RSVP_DST_LEN-1] &&
|
|
|
|
protocol == s->protocol &&
|
2009-11-30 00:55:45 +00:00
|
|
|
!(s->dpi.mask &
|
|
|
|
(*(u32*)(xprt+s->dpi.offset)^s->dpi.key)) &&
|
2005-04-16 22:20:36 +00:00
|
|
|
#if RSVP_DST_LEN == 4
|
2009-11-30 00:55:45 +00:00
|
|
|
dst[0] == s->dst[0] &&
|
|
|
|
dst[1] == s->dst[1] &&
|
|
|
|
dst[2] == s->dst[2] &&
|
2005-04-16 22:20:36 +00:00
|
|
|
#endif
|
2009-11-30 00:55:45 +00:00
|
|
|
tunnelid == s->tunnelid) {
|
2005-04-16 22:20:36 +00:00
|
|
|
|
|
|
|
for (f = s->ht[h2]; f; f = f->next) {
|
|
|
|
if (src[RSVP_DST_LEN-1] == f->src[RSVP_DST_LEN-1] &&
|
|
|
|
!(f->spi.mask & (*(u32*)(xprt+f->spi.offset)^f->spi.key))
|
|
|
|
#if RSVP_DST_LEN == 4
|
2009-11-30 00:55:45 +00:00
|
|
|
&&
|
|
|
|
src[0] == f->src[0] &&
|
|
|
|
src[1] == f->src[1] &&
|
|
|
|
src[2] == f->src[2]
|
2005-04-16 22:20:36 +00:00
|
|
|
#endif
|
|
|
|
) {
|
|
|
|
*res = f->res;
|
|
|
|
RSVP_APPLY_RESULT();
|
|
|
|
|
|
|
|
matched:
|
|
|
|
if (f->tunnelhdr == 0)
|
|
|
|
return 0;
|
|
|
|
|
|
|
|
tunnelid = f->res.classid;
|
|
|
|
nhptr = (void*)(xprt + f->tunnelhdr - sizeof(*nhptr));
|
|
|
|
goto restart;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/* And wildcard bucket... */
|
|
|
|
for (f = s->ht[16]; f; f = f->next) {
|
|
|
|
*res = f->res;
|
|
|
|
RSVP_APPLY_RESULT();
|
|
|
|
goto matched;
|
|
|
|
}
|
|
|
|
return -1;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
return -1;
|
|
|
|
}
|
|
|
|
|
|
|
|
static unsigned long rsvp_get(struct tcf_proto *tp, u32 handle)
|
|
|
|
{
|
|
|
|
struct rsvp_session **sht = ((struct rsvp_head*)tp->root)->ht;
|
|
|
|
struct rsvp_session *s;
|
|
|
|
struct rsvp_filter *f;
|
|
|
|
unsigned h1 = handle&0xFF;
|
|
|
|
unsigned h2 = (handle>>8)&0xFF;
|
|
|
|
|
|
|
|
if (h2 > 16)
|
|
|
|
return 0;
|
|
|
|
|
|
|
|
for (s = sht[h1]; s; s = s->next) {
|
|
|
|
for (f = s->ht[h2]; f; f = f->next) {
|
|
|
|
if (f->handle == handle)
|
|
|
|
return (unsigned long)f;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void rsvp_put(struct tcf_proto *tp, unsigned long f)
|
|
|
|
{
|
|
|
|
}
|
|
|
|
|
|
|
|
static int rsvp_init(struct tcf_proto *tp)
|
|
|
|
{
|
|
|
|
struct rsvp_head *data;
|
|
|
|
|
2006-07-21 21:51:30 +00:00
|
|
|
data = kzalloc(sizeof(struct rsvp_head), GFP_KERNEL);
|
2005-04-16 22:20:36 +00:00
|
|
|
if (data) {
|
|
|
|
tp->root = data;
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
return -ENOBUFS;
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline void
|
|
|
|
rsvp_delete_filter(struct tcf_proto *tp, struct rsvp_filter *f)
|
|
|
|
{
|
|
|
|
tcf_unbind_filter(tp, &f->res);
|
|
|
|
tcf_exts_destroy(tp, &f->exts);
|
|
|
|
kfree(f);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void rsvp_destroy(struct tcf_proto *tp)
|
|
|
|
{
|
|
|
|
struct rsvp_head *data = xchg(&tp->root, NULL);
|
|
|
|
struct rsvp_session **sht;
|
|
|
|
int h1, h2;
|
|
|
|
|
|
|
|
if (data == NULL)
|
|
|
|
return;
|
|
|
|
|
|
|
|
sht = data->ht;
|
|
|
|
|
|
|
|
for (h1=0; h1<256; h1++) {
|
|
|
|
struct rsvp_session *s;
|
|
|
|
|
|
|
|
while ((s = sht[h1]) != NULL) {
|
|
|
|
sht[h1] = s->next;
|
|
|
|
|
|
|
|
for (h2=0; h2<=16; h2++) {
|
|
|
|
struct rsvp_filter *f;
|
|
|
|
|
|
|
|
while ((f = s->ht[h2]) != NULL) {
|
|
|
|
s->ht[h2] = f->next;
|
|
|
|
rsvp_delete_filter(tp, f);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
kfree(s);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
kfree(data);
|
|
|
|
}
|
|
|
|
|
|
|
|
static int rsvp_delete(struct tcf_proto *tp, unsigned long arg)
|
|
|
|
{
|
|
|
|
struct rsvp_filter **fp, *f = (struct rsvp_filter*)arg;
|
|
|
|
unsigned h = f->handle;
|
|
|
|
struct rsvp_session **sp;
|
|
|
|
struct rsvp_session *s = f->sess;
|
|
|
|
int i;
|
|
|
|
|
|
|
|
for (fp = &s->ht[(h>>8)&0xFF]; *fp; fp = &(*fp)->next) {
|
|
|
|
if (*fp == f) {
|
|
|
|
tcf_tree_lock(tp);
|
|
|
|
*fp = f->next;
|
|
|
|
tcf_tree_unlock(tp);
|
|
|
|
rsvp_delete_filter(tp, f);
|
|
|
|
|
|
|
|
/* Strip tree */
|
|
|
|
|
|
|
|
for (i=0; i<=16; i++)
|
|
|
|
if (s->ht[i])
|
|
|
|
return 0;
|
|
|
|
|
|
|
|
/* OK, session has no flows */
|
|
|
|
for (sp = &((struct rsvp_head*)tp->root)->ht[h&0xFF];
|
|
|
|
*sp; sp = &(*sp)->next) {
|
|
|
|
if (*sp == s) {
|
|
|
|
tcf_tree_lock(tp);
|
|
|
|
*sp = s->next;
|
|
|
|
tcf_tree_unlock(tp);
|
|
|
|
|
|
|
|
kfree(s);
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static unsigned gen_handle(struct tcf_proto *tp, unsigned salt)
|
|
|
|
{
|
|
|
|
struct rsvp_head *data = tp->root;
|
|
|
|
int i = 0xFFFF;
|
|
|
|
|
|
|
|
while (i-- > 0) {
|
|
|
|
u32 h;
|
|
|
|
if ((data->hgenerator += 0x10000) == 0)
|
|
|
|
data->hgenerator = 0x10000;
|
|
|
|
h = data->hgenerator|salt;
|
|
|
|
if (rsvp_get(tp, h) == 0)
|
|
|
|
return h;
|
|
|
|
}
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int tunnel_bts(struct rsvp_head *data)
|
|
|
|
{
|
|
|
|
int n = data->tgenerator>>5;
|
|
|
|
u32 b = 1<<(data->tgenerator&0x1F);
|
2007-02-09 14:25:16 +00:00
|
|
|
|
2005-04-16 22:20:36 +00:00
|
|
|
if (data->tmap[n]&b)
|
|
|
|
return 0;
|
|
|
|
data->tmap[n] |= b;
|
|
|
|
return 1;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void tunnel_recycle(struct rsvp_head *data)
|
|
|
|
{
|
|
|
|
struct rsvp_session **sht = data->ht;
|
|
|
|
u32 tmap[256/32];
|
|
|
|
int h1, h2;
|
|
|
|
|
|
|
|
memset(tmap, 0, sizeof(tmap));
|
|
|
|
|
|
|
|
for (h1=0; h1<256; h1++) {
|
|
|
|
struct rsvp_session *s;
|
|
|
|
for (s = sht[h1]; s; s = s->next) {
|
|
|
|
for (h2=0; h2<=16; h2++) {
|
|
|
|
struct rsvp_filter *f;
|
|
|
|
|
|
|
|
for (f = s->ht[h2]; f; f = f->next) {
|
|
|
|
if (f->tunnelhdr == 0)
|
|
|
|
continue;
|
|
|
|
data->tgenerator = f->res.classid;
|
|
|
|
tunnel_bts(data);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
memcpy(data->tmap, tmap, sizeof(tmap));
|
|
|
|
}
|
|
|
|
|
|
|
|
static u32 gen_tunnel(struct rsvp_head *data)
|
|
|
|
{
|
|
|
|
int i, k;
|
|
|
|
|
|
|
|
for (k=0; k<2; k++) {
|
|
|
|
for (i=255; i>0; i--) {
|
|
|
|
if (++data->tgenerator == 0)
|
|
|
|
data->tgenerator = 1;
|
|
|
|
if (tunnel_bts(data))
|
|
|
|
return data->tgenerator;
|
|
|
|
}
|
|
|
|
tunnel_recycle(data);
|
|
|
|
}
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2008-01-24 04:36:12 +00:00
|
|
|
static const struct nla_policy rsvp_policy[TCA_RSVP_MAX + 1] = {
|
|
|
|
[TCA_RSVP_CLASSID] = { .type = NLA_U32 },
|
|
|
|
[TCA_RSVP_DST] = { .type = NLA_BINARY,
|
|
|
|
.len = RSVP_DST_LEN * sizeof(u32) },
|
|
|
|
[TCA_RSVP_SRC] = { .type = NLA_BINARY,
|
|
|
|
.len = RSVP_DST_LEN * sizeof(u32) },
|
|
|
|
[TCA_RSVP_PINFO] = { .len = sizeof(struct tc_rsvp_pinfo) },
|
|
|
|
};
|
|
|
|
|
2005-04-16 22:20:36 +00:00
|
|
|
static int rsvp_change(struct tcf_proto *tp, unsigned long base,
|
|
|
|
u32 handle,
|
2008-01-23 06:11:33 +00:00
|
|
|
struct nlattr **tca,
|
2005-04-16 22:20:36 +00:00
|
|
|
unsigned long *arg)
|
|
|
|
{
|
|
|
|
struct rsvp_head *data = tp->root;
|
|
|
|
struct rsvp_filter *f, **fp;
|
|
|
|
struct rsvp_session *s, **sp;
|
|
|
|
struct tc_rsvp_pinfo *pinfo = NULL;
|
2008-01-23 06:11:33 +00:00
|
|
|
struct nlattr *opt = tca[TCA_OPTIONS-1];
|
|
|
|
struct nlattr *tb[TCA_RSVP_MAX + 1];
|
2005-04-16 22:20:36 +00:00
|
|
|
struct tcf_exts e;
|
|
|
|
unsigned h1, h2;
|
2006-11-21 02:07:51 +00:00
|
|
|
__be32 *dst;
|
2005-04-16 22:20:36 +00:00
|
|
|
int err;
|
|
|
|
|
|
|
|
if (opt == NULL)
|
|
|
|
return handle ? -EINVAL : 0;
|
|
|
|
|
2008-01-24 04:36:12 +00:00
|
|
|
err = nla_parse_nested(tb, TCA_RSVP_MAX, opt, rsvp_policy);
|
2008-01-24 04:33:32 +00:00
|
|
|
if (err < 0)
|
|
|
|
return err;
|
2005-04-16 22:20:36 +00:00
|
|
|
|
|
|
|
err = tcf_exts_validate(tp, tb, tca[TCA_RATE-1], &e, &rsvp_ext_map);
|
|
|
|
if (err < 0)
|
|
|
|
return err;
|
|
|
|
|
|
|
|
if ((f = (struct rsvp_filter*)*arg) != NULL) {
|
|
|
|
/* Node exists: adjust only classid */
|
|
|
|
|
|
|
|
if (f->handle != handle && handle)
|
|
|
|
goto errout2;
|
|
|
|
if (tb[TCA_RSVP_CLASSID-1]) {
|
2008-01-24 04:35:03 +00:00
|
|
|
f->res.classid = nla_get_u32(tb[TCA_RSVP_CLASSID-1]);
|
2005-04-16 22:20:36 +00:00
|
|
|
tcf_bind_filter(tp, &f->res, base);
|
|
|
|
}
|
|
|
|
|
|
|
|
tcf_exts_change(tp, &f->exts, &e);
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Now more serious part... */
|
|
|
|
err = -EINVAL;
|
|
|
|
if (handle)
|
|
|
|
goto errout2;
|
|
|
|
if (tb[TCA_RSVP_DST-1] == NULL)
|
|
|
|
goto errout2;
|
|
|
|
|
|
|
|
err = -ENOBUFS;
|
2006-07-21 21:51:30 +00:00
|
|
|
f = kzalloc(sizeof(struct rsvp_filter), GFP_KERNEL);
|
2005-04-16 22:20:36 +00:00
|
|
|
if (f == NULL)
|
|
|
|
goto errout2;
|
|
|
|
|
|
|
|
h2 = 16;
|
|
|
|
if (tb[TCA_RSVP_SRC-1]) {
|
2008-01-23 06:11:33 +00:00
|
|
|
memcpy(f->src, nla_data(tb[TCA_RSVP_SRC-1]), sizeof(f->src));
|
2005-04-16 22:20:36 +00:00
|
|
|
h2 = hash_src(f->src);
|
|
|
|
}
|
|
|
|
if (tb[TCA_RSVP_PINFO-1]) {
|
2008-01-23 06:11:33 +00:00
|
|
|
pinfo = nla_data(tb[TCA_RSVP_PINFO-1]);
|
2005-04-16 22:20:36 +00:00
|
|
|
f->spi = pinfo->spi;
|
|
|
|
f->tunnelhdr = pinfo->tunnelhdr;
|
|
|
|
}
|
2008-01-24 04:36:12 +00:00
|
|
|
if (tb[TCA_RSVP_CLASSID-1])
|
2008-01-24 04:35:03 +00:00
|
|
|
f->res.classid = nla_get_u32(tb[TCA_RSVP_CLASSID-1]);
|
2005-04-16 22:20:36 +00:00
|
|
|
|
2008-01-23 06:11:33 +00:00
|
|
|
dst = nla_data(tb[TCA_RSVP_DST-1]);
|
2005-04-16 22:20:36 +00:00
|
|
|
h1 = hash_dst(dst, pinfo ? pinfo->protocol : 0, pinfo ? pinfo->tunnelid : 0);
|
|
|
|
|
|
|
|
err = -ENOMEM;
|
|
|
|
if ((f->handle = gen_handle(tp, h1 | (h2<<8))) == 0)
|
|
|
|
goto errout;
|
|
|
|
|
|
|
|
if (f->tunnelhdr) {
|
|
|
|
err = -EINVAL;
|
|
|
|
if (f->res.classid > 255)
|
|
|
|
goto errout;
|
|
|
|
|
|
|
|
err = -ENOMEM;
|
|
|
|
if (f->res.classid == 0 &&
|
|
|
|
(f->res.classid = gen_tunnel(data)) == 0)
|
|
|
|
goto errout;
|
|
|
|
}
|
|
|
|
|
|
|
|
for (sp = &data->ht[h1]; (s=*sp) != NULL; sp = &s->next) {
|
|
|
|
if (dst[RSVP_DST_LEN-1] == s->dst[RSVP_DST_LEN-1] &&
|
|
|
|
pinfo && pinfo->protocol == s->protocol &&
|
2009-11-30 00:55:45 +00:00
|
|
|
memcmp(&pinfo->dpi, &s->dpi, sizeof(s->dpi)) == 0 &&
|
2005-04-16 22:20:36 +00:00
|
|
|
#if RSVP_DST_LEN == 4
|
2009-11-30 00:55:45 +00:00
|
|
|
dst[0] == s->dst[0] &&
|
|
|
|
dst[1] == s->dst[1] &&
|
|
|
|
dst[2] == s->dst[2] &&
|
2005-04-16 22:20:36 +00:00
|
|
|
#endif
|
2009-11-30 00:55:45 +00:00
|
|
|
pinfo->tunnelid == s->tunnelid) {
|
2005-04-16 22:20:36 +00:00
|
|
|
|
|
|
|
insert:
|
|
|
|
/* OK, we found appropriate session */
|
|
|
|
|
|
|
|
fp = &s->ht[h2];
|
|
|
|
|
|
|
|
f->sess = s;
|
|
|
|
if (f->tunnelhdr == 0)
|
|
|
|
tcf_bind_filter(tp, &f->res, base);
|
|
|
|
|
|
|
|
tcf_exts_change(tp, &f->exts, &e);
|
|
|
|
|
|
|
|
for (fp = &s->ht[h2]; *fp; fp = &(*fp)->next)
|
|
|
|
if (((*fp)->spi.mask&f->spi.mask) != f->spi.mask)
|
|
|
|
break;
|
|
|
|
f->next = *fp;
|
|
|
|
wmb();
|
|
|
|
*fp = f;
|
|
|
|
|
|
|
|
*arg = (unsigned long)f;
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/* No session found. Create new one. */
|
|
|
|
|
|
|
|
err = -ENOBUFS;
|
2006-07-21 21:51:30 +00:00
|
|
|
s = kzalloc(sizeof(struct rsvp_session), GFP_KERNEL);
|
2005-04-16 22:20:36 +00:00
|
|
|
if (s == NULL)
|
|
|
|
goto errout;
|
|
|
|
memcpy(s->dst, dst, sizeof(s->dst));
|
|
|
|
|
|
|
|
if (pinfo) {
|
|
|
|
s->dpi = pinfo->dpi;
|
|
|
|
s->protocol = pinfo->protocol;
|
|
|
|
s->tunnelid = pinfo->tunnelid;
|
|
|
|
}
|
|
|
|
for (sp = &data->ht[h1]; *sp; sp = &(*sp)->next) {
|
|
|
|
if (((*sp)->dpi.mask&s->dpi.mask) != s->dpi.mask)
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
s->next = *sp;
|
|
|
|
wmb();
|
|
|
|
*sp = s;
|
2007-02-09 14:25:16 +00:00
|
|
|
|
2005-04-16 22:20:36 +00:00
|
|
|
goto insert;
|
|
|
|
|
|
|
|
errout:
|
2005-11-08 17:41:34 +00:00
|
|
|
kfree(f);
|
2005-04-16 22:20:36 +00:00
|
|
|
errout2:
|
|
|
|
tcf_exts_destroy(tp, &e);
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void rsvp_walk(struct tcf_proto *tp, struct tcf_walker *arg)
|
|
|
|
{
|
|
|
|
struct rsvp_head *head = tp->root;
|
|
|
|
unsigned h, h1;
|
|
|
|
|
|
|
|
if (arg->stop)
|
|
|
|
return;
|
|
|
|
|
|
|
|
for (h = 0; h < 256; h++) {
|
|
|
|
struct rsvp_session *s;
|
|
|
|
|
|
|
|
for (s = head->ht[h]; s; s = s->next) {
|
|
|
|
for (h1 = 0; h1 <= 16; h1++) {
|
|
|
|
struct rsvp_filter *f;
|
|
|
|
|
|
|
|
for (f = s->ht[h1]; f; f = f->next) {
|
|
|
|
if (arg->count < arg->skip) {
|
|
|
|
arg->count++;
|
|
|
|
continue;
|
|
|
|
}
|
|
|
|
if (arg->fn(tp, (unsigned long)f, arg) < 0) {
|
|
|
|
arg->stop = 1;
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
arg->count++;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static int rsvp_dump(struct tcf_proto *tp, unsigned long fh,
|
|
|
|
struct sk_buff *skb, struct tcmsg *t)
|
|
|
|
{
|
|
|
|
struct rsvp_filter *f = (struct rsvp_filter*)fh;
|
|
|
|
struct rsvp_session *s;
|
2007-04-20 03:29:13 +00:00
|
|
|
unsigned char *b = skb_tail_pointer(skb);
|
2008-01-24 04:34:11 +00:00
|
|
|
struct nlattr *nest;
|
2005-04-16 22:20:36 +00:00
|
|
|
struct tc_rsvp_pinfo pinfo;
|
|
|
|
|
|
|
|
if (f == NULL)
|
|
|
|
return skb->len;
|
|
|
|
s = f->sess;
|
|
|
|
|
|
|
|
t->tcm_handle = f->handle;
|
|
|
|
|
2008-01-24 04:34:11 +00:00
|
|
|
nest = nla_nest_start(skb, TCA_OPTIONS);
|
|
|
|
if (nest == NULL)
|
|
|
|
goto nla_put_failure;
|
2005-04-16 22:20:36 +00:00
|
|
|
|
2008-01-23 06:11:33 +00:00
|
|
|
NLA_PUT(skb, TCA_RSVP_DST, sizeof(s->dst), &s->dst);
|
2005-04-16 22:20:36 +00:00
|
|
|
pinfo.dpi = s->dpi;
|
|
|
|
pinfo.spi = f->spi;
|
|
|
|
pinfo.protocol = s->protocol;
|
|
|
|
pinfo.tunnelid = s->tunnelid;
|
|
|
|
pinfo.tunnelhdr = f->tunnelhdr;
|
2005-06-28 19:56:45 +00:00
|
|
|
pinfo.pad = 0;
|
2008-01-23 06:11:33 +00:00
|
|
|
NLA_PUT(skb, TCA_RSVP_PINFO, sizeof(pinfo), &pinfo);
|
2005-04-16 22:20:36 +00:00
|
|
|
if (f->res.classid)
|
2008-01-24 04:34:48 +00:00
|
|
|
NLA_PUT_U32(skb, TCA_RSVP_CLASSID, f->res.classid);
|
2005-04-16 22:20:36 +00:00
|
|
|
if (((f->handle>>8)&0xFF) != 16)
|
2008-01-23 06:11:33 +00:00
|
|
|
NLA_PUT(skb, TCA_RSVP_SRC, sizeof(f->src), f->src);
|
2005-04-16 22:20:36 +00:00
|
|
|
|
|
|
|
if (tcf_exts_dump(skb, &f->exts, &rsvp_ext_map) < 0)
|
2008-01-23 06:11:33 +00:00
|
|
|
goto nla_put_failure;
|
2005-04-16 22:20:36 +00:00
|
|
|
|
2008-01-24 04:34:11 +00:00
|
|
|
nla_nest_end(skb, nest);
|
2005-04-16 22:20:36 +00:00
|
|
|
|
|
|
|
if (tcf_exts_dump_stats(skb, &f->exts, &rsvp_ext_map) < 0)
|
2008-01-23 06:11:33 +00:00
|
|
|
goto nla_put_failure;
|
2005-04-16 22:20:36 +00:00
|
|
|
return skb->len;
|
|
|
|
|
2008-01-23 06:11:33 +00:00
|
|
|
nla_put_failure:
|
2007-03-26 06:06:12 +00:00
|
|
|
nlmsg_trim(skb, b);
|
2005-04-16 22:20:36 +00:00
|
|
|
return -1;
|
|
|
|
}
|
|
|
|
|
|
|
|
static struct tcf_proto_ops RSVP_OPS = {
|
|
|
|
.next = NULL,
|
|
|
|
.kind = RSVP_ID,
|
|
|
|
.classify = rsvp_classify,
|
|
|
|
.init = rsvp_init,
|
|
|
|
.destroy = rsvp_destroy,
|
|
|
|
.get = rsvp_get,
|
|
|
|
.put = rsvp_put,
|
|
|
|
.change = rsvp_change,
|
|
|
|
.delete = rsvp_delete,
|
|
|
|
.walk = rsvp_walk,
|
|
|
|
.dump = rsvp_dump,
|
|
|
|
.owner = THIS_MODULE,
|
|
|
|
};
|
|
|
|
|
|
|
|
static int __init init_rsvp(void)
|
|
|
|
{
|
|
|
|
return register_tcf_proto_ops(&RSVP_OPS);
|
|
|
|
}
|
|
|
|
|
2007-02-09 14:25:16 +00:00
|
|
|
static void __exit exit_rsvp(void)
|
2005-04-16 22:20:36 +00:00
|
|
|
{
|
|
|
|
unregister_tcf_proto_ops(&RSVP_OPS);
|
|
|
|
}
|
|
|
|
|
|
|
|
module_init(init_rsvp)
|
|
|
|
module_exit(exit_rsvp)
|