giomba/nes-proj
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

rpl_ext_header_remove() should only remove RPL Hop-by-Hop extention header

Browse Source
This commit is contained in:
Laurent Deru 2017-12-07 14:58:12 +01:00
parent d2bd0d7198
commit 5bf06d851d
2 changed files with 34 additions and 20 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

27
os/net/rpl-classic/rpl-ext-header.c
View File

@ -592,9 +592,11 @@ rpl_ext_header_remove(void)
{ {
uint8_t temp_len; uint8_t temp_len;
uint8_t rpl_ext_hdr_len; uint8_t rpl_ext_hdr_len;
int uip_ext_opt_offset;
uint8_t *uip_next_hdr; uint8_t *uip_next_hdr;
uip_ext_len = 0; uip_ext_len = 0;
uip_ext_opt_offset = 2;
uip_next_hdr = &UIP_IP_BUF->proto; uip_next_hdr = &UIP_IP_BUF->proto;
/* Look for hop-by-hop and routing headers */ /* Look for hop-by-hop and routing headers */
@ -602,17 +604,22 @@ rpl_ext_header_remove(void)
switch(*uip_next_hdr) { switch(*uip_next_hdr) {
case UIP_PROTO_HBHO: case UIP_PROTO_HBHO:
case UIP_PROTO_ROUTING: case UIP_PROTO_ROUTING:
/* Remove hop-by-hop and routing headers */ if((*uip_next_hdr != UIP_PROTO_HBHO || UIP_EXT_HDR_OPT_RPL_BUF->opt_type == UIP_EXT_HDR_OPT_RPL)) {
*uip_next_hdr = UIP_EXT_BUF->next; /* Remove hop-by-hop and routing headers */
rpl_ext_hdr_len = (UIP_EXT_BUF->len * 8) + 8; *uip_next_hdr = UIP_EXT_BUF->next;
temp_len = UIP_IP_BUF->len[1]; rpl_ext_hdr_len = (UIP_EXT_BUF->len * 8) + 8;
uip_len -= rpl_ext_hdr_len; temp_len = UIP_IP_BUF->len[1];
UIP_IP_BUF->len[1] -= rpl_ext_hdr_len; uip_len -= rpl_ext_hdr_len;
if(UIP_IP_BUF->len[1] > temp_len) { UIP_IP_BUF->len[1] -= rpl_ext_hdr_len;
UIP_IP_BUF->len[0]--; if(UIP_IP_BUF->len[1] > temp_len) {
UIP_IP_BUF->len[0]--;
}
PRINTF("RPL: Removing RPL extension header (type %u, len %u)\n", *uip_next_hdr, rpl_ext_hdr_len);
memmove(UIP_EXT_BUF, ((uint8_t *)UIP_EXT_BUF) + rpl_ext_hdr_len, uip_len - UIP_IPH_LEN);
} else {
uip_next_hdr = &UIP_EXT_BUF->next;
uip_ext_len += (UIP_EXT_BUF->len << 3) + 8;
} }
PRINTF("RPL: Removing RPL extension header (type %u, len %u)\n", *uip_next_hdr, rpl_ext_hdr_len);
memmove(UIP_EXT_BUF, ((uint8_t *)UIP_EXT_BUF) + rpl_ext_hdr_len, uip_len - UIP_IPH_LEN);
break; break;
case UIP_PROTO_DESTO: case UIP_PROTO_DESTO:
/* /*

27
os/net/rpl-lite/rpl-ext-header.c
View File

@ -531,9 +531,11 @@ rpl_ext_header_remove(void)
{ {
uint8_t temp_len; uint8_t temp_len;
uint8_t rpl_ext_hdr_len; uint8_t rpl_ext_hdr_len;
int uip_ext_opt_offset;
uint8_t *uip_next_hdr; uint8_t *uip_next_hdr;
uip_ext_len = 0; uip_ext_len = 0;
uip_ext_opt_offset = 2;
uip_next_hdr = &UIP_IP_BUF->proto; uip_next_hdr = &UIP_IP_BUF->proto;
/* Look for hop-by-hop and routing headers */ /* Look for hop-by-hop and routing headers */
@ -541,17 +543,22 @@ rpl_ext_header_remove(void)
switch(*uip_next_hdr) { switch(*uip_next_hdr) {
case UIP_PROTO_HBHO: case UIP_PROTO_HBHO:
case UIP_PROTO_ROUTING: case UIP_PROTO_ROUTING:
/* Remove hop-by-hop and routing headers */ if((*uip_next_hdr != UIP_PROTO_HBHO || UIP_EXT_HDR_OPT_RPL_BUF->opt_type == UIP_EXT_HDR_OPT_RPL)) {
*uip_next_hdr = UIP_EXT_BUF->next; /* Remove hop-by-hop and routing headers */
rpl_ext_hdr_len = (UIP_EXT_BUF->len * 8) + 8; *uip_next_hdr = UIP_EXT_BUF->next;
temp_len = UIP_IP_BUF->len[1]; rpl_ext_hdr_len = (UIP_EXT_BUF->len * 8) + 8;
uip_len -= rpl_ext_hdr_len; temp_len = UIP_IP_BUF->len[1];
UIP_IP_BUF->len[1] -= rpl_ext_hdr_len; uip_len -= rpl_ext_hdr_len;
if(UIP_IP_BUF->len[1] > temp_len) { UIP_IP_BUF->len[1] -= rpl_ext_hdr_len;
UIP_IP_BUF->len[0]--; if(UIP_IP_BUF->len[1] > temp_len) {
UIP_IP_BUF->len[0]--;
}
LOG_INFO("removing RPL extension header (type %u, len %u)\n", *uip_next_hdr, rpl_ext_hdr_len);
memmove(UIP_EXT_BUF, ((uint8_t *)UIP_EXT_BUF) + rpl_ext_hdr_len, uip_len - UIP_IPH_LEN);
} else {
uip_next_hdr = &UIP_EXT_BUF->next;
uip_ext_len += (UIP_EXT_BUF->len << 3) + 8;
} }
LOG_INFO("removing RPL extension header (type %u, len %u)\n", *uip_next_hdr, rpl_ext_hdr_len);
memmove(UIP_EXT_BUF, ((uint8_t *)UIP_EXT_BUF) + rpl_ext_hdr_len, uip_len - UIP_IPH_LEN);
break; break;
case UIP_PROTO_DESTO: case UIP_PROTO_DESTO:
/* /*