|
@@ -33,12 +33,12 @@ MODULE_AUTHOR("Andras Kis-Szabo <kisza@sch.bme.hu>");
|
|
|
static inline int
|
|
|
segsleft_match(u_int32_t min, u_int32_t max, u_int32_t id, int invert)
|
|
|
{
|
|
|
- int r=0;
|
|
|
- DEBUGP("rt segsleft_match:%c 0x%x <= 0x%x <= 0x%x",invert? '!':' ',
|
|
|
- min,id,max);
|
|
|
- r=(id >= min && id <= max) ^ invert;
|
|
|
- DEBUGP(" result %s\n",r? "PASS" : "FAILED");
|
|
|
- return r;
|
|
|
+ int r = 0;
|
|
|
+ DEBUGP("rt segsleft_match:%c 0x%x <= 0x%x <= 0x%x",
|
|
|
+ invert ? '!' : ' ', min, id, max);
|
|
|
+ r = (id >= min && id <= max) ^ invert;
|
|
|
+ DEBUGP(" result %s\n", r ? "PASS" : "FAILED");
|
|
|
+ return r;
|
|
|
}
|
|
|
|
|
|
static int
|
|
@@ -50,87 +50,93 @@ match(const struct sk_buff *skb,
|
|
|
unsigned int protoff,
|
|
|
int *hotdrop)
|
|
|
{
|
|
|
- struct ipv6_rt_hdr _route, *rh;
|
|
|
- const struct ip6t_rt *rtinfo = matchinfo;
|
|
|
- unsigned int temp;
|
|
|
- unsigned int ptr;
|
|
|
- unsigned int hdrlen = 0;
|
|
|
- unsigned int ret = 0;
|
|
|
- struct in6_addr *ap, _addr;
|
|
|
+ struct ipv6_rt_hdr _route, *rh;
|
|
|
+ const struct ip6t_rt *rtinfo = matchinfo;
|
|
|
+ unsigned int temp;
|
|
|
+ unsigned int ptr;
|
|
|
+ unsigned int hdrlen = 0;
|
|
|
+ unsigned int ret = 0;
|
|
|
+ struct in6_addr *ap, _addr;
|
|
|
|
|
|
if (ipv6_find_hdr(skb, &ptr, NEXTHDR_ROUTING, NULL) < 0)
|
|
|
return 0;
|
|
|
|
|
|
- rh = skb_header_pointer(skb, ptr, sizeof(_route), &_route);
|
|
|
- if (rh == NULL){
|
|
|
- *hotdrop = 1;
|
|
|
- return 0;
|
|
|
- }
|
|
|
-
|
|
|
- hdrlen = ipv6_optlen(rh);
|
|
|
- if (skb->len - ptr < hdrlen){
|
|
|
- /* Pcket smaller than its length field */
|
|
|
- return 0;
|
|
|
- }
|
|
|
-
|
|
|
- DEBUGP("IPv6 RT LEN %u %u ", hdrlen, rh->hdrlen);
|
|
|
- DEBUGP("TYPE %04X ", rh->type);
|
|
|
- DEBUGP("SGS_LEFT %u %02X\n", rh->segments_left, rh->segments_left);
|
|
|
-
|
|
|
- DEBUGP("IPv6 RT segsleft %02X ",
|
|
|
- (segsleft_match(rtinfo->segsleft[0], rtinfo->segsleft[1],
|
|
|
- rh->segments_left,
|
|
|
- !!(rtinfo->invflags & IP6T_RT_INV_SGS))));
|
|
|
- DEBUGP("type %02X %02X %02X ",
|
|
|
- rtinfo->rt_type, rh->type,
|
|
|
- (!(rtinfo->flags & IP6T_RT_TYP) ||
|
|
|
- ((rtinfo->rt_type == rh->type) ^
|
|
|
- !!(rtinfo->invflags & IP6T_RT_INV_TYP))));
|
|
|
- DEBUGP("len %02X %04X %02X ",
|
|
|
- rtinfo->hdrlen, hdrlen,
|
|
|
- (!(rtinfo->flags & IP6T_RT_LEN) ||
|
|
|
- ((rtinfo->hdrlen == hdrlen) ^
|
|
|
- !!(rtinfo->invflags & IP6T_RT_INV_LEN))));
|
|
|
- DEBUGP("res %02X %02X %02X ",
|
|
|
- (rtinfo->flags & IP6T_RT_RES), ((struct rt0_hdr *)rh)->reserved,
|
|
|
- !((rtinfo->flags & IP6T_RT_RES) && (((struct rt0_hdr *)rh)->reserved)));
|
|
|
-
|
|
|
- ret = (rh != NULL)
|
|
|
- &&
|
|
|
- (segsleft_match(rtinfo->segsleft[0], rtinfo->segsleft[1],
|
|
|
- rh->segments_left,
|
|
|
- !!(rtinfo->invflags & IP6T_RT_INV_SGS)))
|
|
|
- &&
|
|
|
- (!(rtinfo->flags & IP6T_RT_LEN) ||
|
|
|
- ((rtinfo->hdrlen == hdrlen) ^
|
|
|
- !!(rtinfo->invflags & IP6T_RT_INV_LEN)))
|
|
|
- &&
|
|
|
- (!(rtinfo->flags & IP6T_RT_TYP) ||
|
|
|
- ((rtinfo->rt_type == rh->type) ^
|
|
|
- !!(rtinfo->invflags & IP6T_RT_INV_TYP)));
|
|
|
+ rh = skb_header_pointer(skb, ptr, sizeof(_route), &_route);
|
|
|
+ if (rh == NULL) {
|
|
|
+ *hotdrop = 1;
|
|
|
+ return 0;
|
|
|
+ }
|
|
|
+
|
|
|
+ hdrlen = ipv6_optlen(rh);
|
|
|
+ if (skb->len - ptr < hdrlen) {
|
|
|
+ /* Pcket smaller than its length field */
|
|
|
+ return 0;
|
|
|
+ }
|
|
|
+
|
|
|
+ DEBUGP("IPv6 RT LEN %u %u ", hdrlen, rh->hdrlen);
|
|
|
+ DEBUGP("TYPE %04X ", rh->type);
|
|
|
+ DEBUGP("SGS_LEFT %u %02X\n", rh->segments_left, rh->segments_left);
|
|
|
+
|
|
|
+ DEBUGP("IPv6 RT segsleft %02X ",
|
|
|
+ (segsleft_match(rtinfo->segsleft[0], rtinfo->segsleft[1],
|
|
|
+ rh->segments_left,
|
|
|
+ !!(rtinfo->invflags & IP6T_RT_INV_SGS))));
|
|
|
+ DEBUGP("type %02X %02X %02X ",
|
|
|
+ rtinfo->rt_type, rh->type,
|
|
|
+ (!(rtinfo->flags & IP6T_RT_TYP) ||
|
|
|
+ ((rtinfo->rt_type == rh->type) ^
|
|
|
+ !!(rtinfo->invflags & IP6T_RT_INV_TYP))));
|
|
|
+ DEBUGP("len %02X %04X %02X ",
|
|
|
+ rtinfo->hdrlen, hdrlen,
|
|
|
+ (!(rtinfo->flags & IP6T_RT_LEN) ||
|
|
|
+ ((rtinfo->hdrlen == hdrlen) ^
|
|
|
+ !!(rtinfo->invflags & IP6T_RT_INV_LEN))));
|
|
|
+ DEBUGP("res %02X %02X %02X ",
|
|
|
+ (rtinfo->flags & IP6T_RT_RES),
|
|
|
+ ((struct rt0_hdr *)rh)->reserved,
|
|
|
+ !((rtinfo->flags & IP6T_RT_RES) &&
|
|
|
+ (((struct rt0_hdr *)rh)->reserved)));
|
|
|
+
|
|
|
+ ret = (rh != NULL)
|
|
|
+ &&
|
|
|
+ (segsleft_match(rtinfo->segsleft[0], rtinfo->segsleft[1],
|
|
|
+ rh->segments_left,
|
|
|
+ !!(rtinfo->invflags & IP6T_RT_INV_SGS)))
|
|
|
+ &&
|
|
|
+ (!(rtinfo->flags & IP6T_RT_LEN) ||
|
|
|
+ ((rtinfo->hdrlen == hdrlen) ^
|
|
|
+ !!(rtinfo->invflags & IP6T_RT_INV_LEN)))
|
|
|
+ &&
|
|
|
+ (!(rtinfo->flags & IP6T_RT_TYP) ||
|
|
|
+ ((rtinfo->rt_type == rh->type) ^
|
|
|
+ !!(rtinfo->invflags & IP6T_RT_INV_TYP)));
|
|
|
|
|
|
if (ret && (rtinfo->flags & IP6T_RT_RES)) {
|
|
|
u_int32_t *rp, _reserved;
|
|
|
rp = skb_header_pointer(skb,
|
|
|
- ptr + offsetof(struct rt0_hdr, reserved),
|
|
|
- sizeof(_reserved), &_reserved);
|
|
|
+ ptr + offsetof(struct rt0_hdr,
|
|
|
+ reserved),
|
|
|
+ sizeof(_reserved),
|
|
|
+ &_reserved);
|
|
|
|
|
|
ret = (*rp == 0);
|
|
|
}
|
|
|
|
|
|
- DEBUGP("#%d ",rtinfo->addrnr);
|
|
|
- if ( !(rtinfo->flags & IP6T_RT_FST) ){
|
|
|
- return ret;
|
|
|
+ DEBUGP("#%d ", rtinfo->addrnr);
|
|
|
+ if (!(rtinfo->flags & IP6T_RT_FST)) {
|
|
|
+ return ret;
|
|
|
} else if (rtinfo->flags & IP6T_RT_FST_NSTRICT) {
|
|
|
DEBUGP("Not strict ");
|
|
|
- if ( rtinfo->addrnr > (unsigned int)((hdrlen-8)/16) ){
|
|
|
+ if (rtinfo->addrnr > (unsigned int)((hdrlen - 8) / 16)) {
|
|
|
DEBUGP("There isn't enough space\n");
|
|
|
return 0;
|
|
|
} else {
|
|
|
unsigned int i = 0;
|
|
|
|
|
|
- DEBUGP("#%d ",rtinfo->addrnr);
|
|
|
- for(temp=0; temp<(unsigned int)((hdrlen-8)/16); temp++){
|
|
|
+ DEBUGP("#%d ", rtinfo->addrnr);
|
|
|
+ for (temp = 0;
|
|
|
+ temp < (unsigned int)((hdrlen - 8) / 16);
|
|
|
+ temp++) {
|
|
|
ap = skb_header_pointer(skb,
|
|
|
ptr
|
|
|
+ sizeof(struct rt0_hdr)
|
|
@@ -141,24 +147,26 @@ match(const struct sk_buff *skb,
|
|
|
BUG_ON(ap == NULL);
|
|
|
|
|
|
if (ipv6_addr_equal(ap, &rtinfo->addrs[i])) {
|
|
|
- DEBUGP("i=%d temp=%d;\n",i,temp);
|
|
|
+ DEBUGP("i=%d temp=%d;\n", i, temp);
|
|
|
i++;
|
|
|
}
|
|
|
- if (i==rtinfo->addrnr) break;
|
|
|
+ if (i == rtinfo->addrnr)
|
|
|
+ break;
|
|
|
}
|
|
|
DEBUGP("i=%d #%d\n", i, rtinfo->addrnr);
|
|
|
if (i == rtinfo->addrnr)
|
|
|
return ret;
|
|
|
- else return 0;
|
|
|
+ else
|
|
|
+ return 0;
|
|
|
}
|
|
|
} else {
|
|
|
DEBUGP("Strict ");
|
|
|
- if ( rtinfo->addrnr > (unsigned int)((hdrlen-8)/16) ){
|
|
|
+ if (rtinfo->addrnr > (unsigned int)((hdrlen - 8) / 16)) {
|
|
|
DEBUGP("There isn't enough space\n");
|
|
|
return 0;
|
|
|
} else {
|
|
|
- DEBUGP("#%d ",rtinfo->addrnr);
|
|
|
- for(temp=0; temp<rtinfo->addrnr; temp++){
|
|
|
+ DEBUGP("#%d ", rtinfo->addrnr);
|
|
|
+ for (temp = 0; temp < rtinfo->addrnr; temp++) {
|
|
|
ap = skb_header_pointer(skb,
|
|
|
ptr
|
|
|
+ sizeof(struct rt0_hdr)
|
|
@@ -171,9 +179,11 @@ match(const struct sk_buff *skb,
|
|
|
break;
|
|
|
}
|
|
|
DEBUGP("temp=%d #%d\n", temp, rtinfo->addrnr);
|
|
|
- if ((temp == rtinfo->addrnr) && (temp == (unsigned int)((hdrlen-8)/16)))
|
|
|
+ if ((temp == rtinfo->addrnr) &&
|
|
|
+ (temp == (unsigned int)((hdrlen - 8) / 16)))
|
|
|
return ret;
|
|
|
- else return 0;
|
|
|
+ else
|
|
|
+ return 0;
|
|
|
}
|
|
|
}
|
|
|
|
|
@@ -183,32 +193,31 @@ match(const struct sk_buff *skb,
|
|
|
/* Called when user tries to insert an entry of this type. */
|
|
|
static int
|
|
|
checkentry(const char *tablename,
|
|
|
- const void *entry,
|
|
|
- void *matchinfo,
|
|
|
- unsigned int matchinfosize,
|
|
|
- unsigned int hook_mask)
|
|
|
+ const void *entry,
|
|
|
+ void *matchinfo,
|
|
|
+ unsigned int matchinfosize,
|
|
|
+ unsigned int hook_mask)
|
|
|
{
|
|
|
- const struct ip6t_rt *rtinfo = matchinfo;
|
|
|
-
|
|
|
- if (matchinfosize != IP6T_ALIGN(sizeof(struct ip6t_rt))) {
|
|
|
- DEBUGP("ip6t_rt: matchsize %u != %u\n",
|
|
|
- matchinfosize, IP6T_ALIGN(sizeof(struct ip6t_rt)));
|
|
|
- return 0;
|
|
|
- }
|
|
|
- if (rtinfo->invflags & ~IP6T_RT_INV_MASK) {
|
|
|
- DEBUGP("ip6t_rt: unknown flags %X\n",
|
|
|
- rtinfo->invflags);
|
|
|
- return 0;
|
|
|
- }
|
|
|
- if ( (rtinfo->flags & (IP6T_RT_RES|IP6T_RT_FST_MASK)) &&
|
|
|
- (!(rtinfo->flags & IP6T_RT_TYP) ||
|
|
|
- (rtinfo->rt_type != 0) ||
|
|
|
- (rtinfo->invflags & IP6T_RT_INV_TYP)) ) {
|
|
|
- DEBUGP("`--rt-type 0' required before `--rt-0-*'");
|
|
|
- return 0;
|
|
|
- }
|
|
|
-
|
|
|
- return 1;
|
|
|
+ const struct ip6t_rt *rtinfo = matchinfo;
|
|
|
+
|
|
|
+ if (matchinfosize != IP6T_ALIGN(sizeof(struct ip6t_rt))) {
|
|
|
+ DEBUGP("ip6t_rt: matchsize %u != %u\n",
|
|
|
+ matchinfosize, IP6T_ALIGN(sizeof(struct ip6t_rt)));
|
|
|
+ return 0;
|
|
|
+ }
|
|
|
+ if (rtinfo->invflags & ~IP6T_RT_INV_MASK) {
|
|
|
+ DEBUGP("ip6t_rt: unknown flags %X\n", rtinfo->invflags);
|
|
|
+ return 0;
|
|
|
+ }
|
|
|
+ if ((rtinfo->flags & (IP6T_RT_RES | IP6T_RT_FST_MASK)) &&
|
|
|
+ (!(rtinfo->flags & IP6T_RT_TYP) ||
|
|
|
+ (rtinfo->rt_type != 0) ||
|
|
|
+ (rtinfo->invflags & IP6T_RT_INV_TYP))) {
|
|
|
+ DEBUGP("`--rt-type 0' required before `--rt-0-*'");
|
|
|
+ return 0;
|
|
|
+ }
|
|
|
+
|
|
|
+ return 1;
|
|
|
}
|
|
|
|
|
|
static struct ip6t_match rt_match = {
|
|
@@ -220,12 +229,12 @@ static struct ip6t_match rt_match = {
|
|
|
|
|
|
static int __init init(void)
|
|
|
{
|
|
|
- return ip6t_register_match(&rt_match);
|
|
|
+ return ip6t_register_match(&rt_match);
|
|
|
}
|
|
|
|
|
|
static void __exit cleanup(void)
|
|
|
{
|
|
|
- ip6t_unregister_match(&rt_match);
|
|
|
+ ip6t_unregister_match(&rt_match);
|
|
|
}
|
|
|
|
|
|
module_init(init);
|