47#include "net/routing/rpl-lite/rpl.h"
53#define LOG_MODULE "RPL"
54#define LOG_LEVEL LOG_LEVEL_RPL
58rpl_ext_header_srh_get_next_hop(uip_ipaddr_t *
ipaddr)
60 struct uip_routing_hdr *rh_header;
65 rh_header = (
struct uip_routing_hdr *)uipbuf_search_header(
uip_buf,
uip_len, UIP_PROTO_ROUTING);
74 if((rh_header != NULL && rh_header->routing_type == RPL_RH_TYPE_SRH) ||
75 (dest_node != NULL && root_node != NULL &&
76 dest_node->parent == root_node)) {
82 uip_create_linklocal_prefix(
ipaddr);
86 LOG_DBG(
"no SRH found\n");
91srh_is_valid(
struct uip_routing_hdr *rh_header,
92 struct uip_rpl_srh_hdr *srh_header)
94 uip_ipaddr_t hop_addr;
97 uint8_t segments_left = rh_header->seg_left;
98 uint8_t ext_len = rh_header->len * 8 + 8;
99 uint8_t cmpri = srh_header->cmpr >> 4;
100 uint8_t cmpre = srh_header->cmpr & 0x0f;
101 uint8_t padding = srh_header->pad >> 4;
102 uint8_t path_len = ((ext_len - padding - RPL_RH_LEN - RPL_SRH_LEN - (16 - cmpre)) / (16 - cmpri)) + 1;
104 bool prev_hop_is_my_addr =
false;
105 uint8_t my_addr_count = 0;
106 for(uint8_t i = path_len - segments_left; i < path_len; i++) {
107 uint8_t cmpr = segments_left == 1 ? cmpre : cmpri;
108 ptrdiff_t rh_offset = (uint8_t *)rh_header -
uip_buf;
109 size_t addr_offset = RPL_RH_LEN + RPL_SRH_LEN + (i * (16 - cmpri));
111 if(rh_offset + addr_offset + 16 - cmpr >
UIP_BUFSIZE) {
115 uint8_t *addr_ptr = (uint8_t *)rh_header + addr_offset;
116 memcpy((uint8_t *)&hop_addr + cmpr, addr_ptr, 16 - cmpr);
118 LOG_DBG(
"Processing SRH hop %u, IP addr ", i);
119 LOG_DBG_6ADDR(&hop_addr);
131 if(uip_ds6_is_my_addr(&hop_addr) ||
132 uip_ds6_is_my_maddr(&hop_addr)) {
134 if(!prev_hop_is_my_addr && my_addr_count > 1) {
135 LOG_WARN(
"SRH contains a loop\n");
138 prev_hop_is_my_addr =
true;
140 prev_hop_is_my_addr =
false;
146 LOG_WARN(
"SRH contains an invalid next hop address\n");
155rpl_ext_header_srh_update(
void)
157 struct uip_routing_hdr *rh_header;
158 struct uip_rpl_srh_hdr *srh_header;
159 uint8_t cmpri, cmpre;
163 uint8_t segments_left;
164 uip_ipaddr_t current_dest_addr;
167 rh_header = (
struct uip_routing_hdr *)uipbuf_search_header(
uip_buf,
uip_len, UIP_PROTO_ROUTING);
169 if(rh_header == NULL || rh_header->routing_type != RPL_RH_TYPE_SRH) {
170 LOG_INFO(
"SRH not found\n");
175 srh_header = (
struct uip_rpl_srh_hdr *)(((uint8_t *)rh_header) + RPL_RH_LEN);
176 segments_left = rh_header->seg_left;
177 ext_len = rh_header->len * 8 + 8;
178 cmpri = srh_header->cmpr >> 4;
179 cmpre = srh_header->cmpr & 0x0f;
180 padding = srh_header->pad >> 4;
181 path_len = ((ext_len - padding - RPL_RH_LEN - RPL_SRH_LEN - (16 - cmpre)) / (16 - cmpri)) + 1;
184 LOG_INFO(
"read SRH, path len %u, segments left %u, Cmpri %u, Cmpre %u, ext len %u (padding %u)\n",
185 path_len, segments_left, cmpri, cmpre, ext_len, padding);
188 if(segments_left == 0) {
190 }
else if(segments_left > path_len) {
192 LOG_ERR(
"SRH with too many segments left (%u > %u)\n",
193 segments_left, path_len);
196 if(!srh_is_valid(rh_header, srh_header)) {
197 LOG_ERR(
"Invalid SRH hop sequence\n");
201 uint8_t i = path_len - segments_left;
202 uint8_t cmpr = segments_left == 1 ? cmpre : cmpri;
203 ptrdiff_t rh_offset = (uint8_t *)rh_header -
uip_buf;
204 size_t addr_offset = RPL_RH_LEN + RPL_SRH_LEN + (i * (16 - cmpri));
206 if(rh_offset + addr_offset + 16 - cmpr >
UIP_BUFSIZE) {
207 LOG_ERR(
"Invalid SRH address pointer\n");
211 uint8_t *addr_ptr = ((uint8_t *)rh_header) + addr_offset;
218 memcpy(((uint8_t *)&
UIP_IP_BUF->destipaddr) + cmpr, addr_ptr, 16 - cmpr);
220 memcpy(addr_ptr, ((uint8_t *)¤t_dest_addr) + cmpr, 16 - cmpr);
223 rh_header->seg_left--;
225 LOG_INFO(
"SRH next hop ");
236count_matching_bytes(
const void *p1,
const void *p2,
size_t n)
238 for(
size_t i = 0; i < n; i++) {
239 if(((uint8_t *)p1)[i] != ((uint8_t *)p2)[i]) {
251insert_srh_header(
void)
256 uint8_t cmpri, cmpre;
262 uip_ipaddr_t node_addr;
265 struct uip_routing_hdr *rh_hdr = (
struct uip_routing_hdr *)UIP_IP_PAYLOAD(0);
266 struct uip_rpl_srh_hdr *srh_hdr = (
struct uip_rpl_srh_hdr *)(UIP_IP_PAYLOAD(0) + RPL_RH_LEN);
268 LOG_INFO(
"SRH creating source routing header with destination ");
278 LOG_INFO(
"SRH destination not in our DAG, skip SRH insertion\n");
283 if(dest_node == NULL) {
285 LOG_INFO(
"SRH node not found, skip SRH insertion\n");
290 if(root_node == NULL) {
291 LOG_ERR(
"SRH root node not found\n");
296 LOG_ERR(
"SRH no path found to destination\n");
302 node = dest_node->parent;
311 while(node != NULL && node != root_node) {
316 cmpri = MIN(cmpri, count_matching_bytes(&node_addr, &
UIP_IP_BUF->destipaddr, 16));
319 LOG_INFO(
"SRH Hop ");
320 LOG_INFO_6ADDR(&node_addr);
327 ext_len = RPL_RH_LEN + RPL_SRH_LEN
328 + (path_len - 1) * (16 - cmpre)
331 padding = ext_len % 8 == 0 ? 0 : (8 - (ext_len % 8));
334 LOG_INFO(
"SRH path len: %u, ComprI %u, ComprE %u, ext len %u (padding %u)\n",
335 path_len, cmpri, cmpre, ext_len, padding);
339 LOG_ERR(
"packet too long: impossible to add source routing header (%u bytes)\n", ext_len);
353 rh_hdr->len = (ext_len - 8) / 8;
354 rh_hdr->routing_type = RPL_RH_TYPE_SRH;
355 rh_hdr->seg_left = path_len;
358 srh_hdr->cmpr = (cmpri << 4) + cmpre;
359 srh_hdr->pad = padding << 4;
364 hop_ptr = ((uint8_t *)rh_hdr) + ext_len - padding;
366 while(node != NULL && node->parent != root_node) {
369 hop_ptr -= (16 - cmpri);
370 memcpy(hop_ptr, ((uint8_t*)&node_addr) + cmpri, 16 - cmpri);
380 uipbuf_add_ext_hdr(ext_len);
387rpl_ext_header_hbh_update(uint8_t *ext_buf,
int opt_offset)
390 int rank_error_signaled;
392 uint16_t sender_rank;
393 uint8_t sender_closer;
397 if(opt_offset < 0 || opt_offset & 1) {
398 LOG_ERR(
"Invalid RPL option offset: %d\n", opt_offset);
402 struct uip_hbho_hdr *hbh_hdr = (
struct uip_hbho_hdr *)ext_buf;
403 struct uip_ext_hdr_opt_rpl *rpl_opt = (
struct uip_ext_hdr_opt_rpl *)(ext_buf + opt_offset);
405 if(hbh_hdr->len != ((RPL_HOP_BY_HOP_LEN - 8) / 8)
406 || rpl_opt->opt_type != UIP_EXT_HDR_OPT_RPL
407 || rpl_opt->opt_len != RPL_HDR_OPT_LEN) {
408 LOG_ERR(
"hop-by-hop extension header has wrong size or type (%u %u %u)\n",
409 hbh_hdr->len, rpl_opt->opt_type, rpl_opt->opt_len);
413 if(!curr_instance.used || curr_instance.instance_id != rpl_opt->instance) {
414 LOG_ERR(
"unknown instance: %u\n", rpl_opt->instance);
418 if(rpl_opt->flags & RPL_HDR_OPT_FWD_ERR) {
419 LOG_ERR(
"forward error!\n");
423 down = (rpl_opt->flags & RPL_HDR_OPT_DOWN) ? 1 : 0;
424 sender_rank =
UIP_HTONS(rpl_opt->senderrank);
425 sender = nbr_table_get_from_lladdr(rpl_neighbors, packetbuf_addr(PACKETBUF_ADDR_SENDER));
426 rank_error_signaled = (rpl_opt->flags & RPL_HDR_OPT_RANK_ERR) ? 1 : 0;
427 sender_closer = sender_rank < curr_instance.dag.rank;
428 loop_detected = down != sender_closer;
430 LOG_INFO(
"ext hdr: packet from ");
434 LOG_INFO_(
" going %s, sender closer %d (%d < %d), rank error %u, loop detected %u\n",
435 down == 1 ?
"down" :
"up", sender_closer, sender_rank,
436 curr_instance.dag.rank, rank_error_signaled, loop_detected);
440 rpl_opt->flags |= RPL_HDR_OPT_RANK_ERR;
443 return rpl_process_hbh(sender, sender_rank, loop_detected, rank_error_signaled);
450update_hbh_header(
void)
452 struct uip_hbho_hdr *hbh_hdr = (
struct uip_hbho_hdr *)UIP_IP_PAYLOAD(0);
453 struct uip_ext_hdr_opt_rpl *rpl_opt = (
struct uip_ext_hdr_opt_rpl *)(UIP_IP_PAYLOAD(2));
456 if(hbh_hdr->len != ((RPL_HOP_BY_HOP_LEN - 8) / 8)
457 || rpl_opt->opt_len != RPL_HDR_OPT_LEN) {
459 LOG_ERR(
"hop-by-hop extension header has wrong size (%u)\n", rpl_opt->opt_len);
463 if(!curr_instance.used || curr_instance.instance_id != rpl_opt->instance) {
464 LOG_ERR(
"unable to add/update hop-by-hop extension header: incorrect instance\n");
469 rpl_opt->senderrank =
UIP_HTONS(curr_instance.dag.rank);
470 rpl_opt->instance = curr_instance.instance_id;
481insert_hbh_header(
void)
483 struct uip_hbho_hdr *hbh_hdr = (
struct uip_hbho_hdr *)UIP_IP_PAYLOAD(0);
484 struct uip_ext_hdr_opt_rpl *rpl_opt = (
struct uip_ext_hdr_opt_rpl *)(UIP_IP_PAYLOAD(2));
487 LOG_INFO(
"creating hop-by-hop option\n");
489 LOG_ERR(
"packet too long: impossible to add hop-by-hop option\n");
494 memmove(UIP_IP_PAYLOAD(RPL_HOP_BY_HOP_LEN), UIP_IP_PAYLOAD(0),
uip_len - UIP_IPH_LEN);
495 memset(UIP_IP_PAYLOAD(0), 0, RPL_HOP_BY_HOP_LEN);
502 hbh_hdr->len = (RPL_HOP_BY_HOP_LEN - 8) / 8;
503 rpl_opt->opt_type = UIP_EXT_HDR_OPT_RPL;
504 rpl_opt->opt_len = RPL_HDR_OPT_LEN;
506 rpl_opt->senderrank =
UIP_HTONS(curr_instance.dag.rank);
507 rpl_opt->instance = curr_instance.instance_id;
509 uipbuf_add_ext_hdr(RPL_HOP_BY_HOP_LEN);
513 return update_hbh_header();
517rpl_ext_header_update(
void)
519 if(!curr_instance.used
525 if(rpl_dag_root_is_root()) {
528 rpl_ext_header_remove();
530 return insert_srh_header();
536 return insert_hbh_header();
539 return update_hbh_header();
545rpl_ext_header_remove(
void)
547 uint8_t *prev_proto_ptr;
550 uint8_t *next_header;
551 struct uip_ext_hdr *ext_ptr;
552 struct uip_ext_hdr_opt *opt_ptr;
554 next_header = uipbuf_get_next_header(
uip_buf,
uip_len, &protocol,
true);
555 if(next_header == NULL) {
558 ext_ptr = (
struct uip_ext_hdr *)next_header;
561 while(uip_is_proto_ext_hdr(protocol)) {
562 opt_ptr = (
struct uip_ext_hdr_opt *)(next_header + 2);
563 if(protocol == UIP_PROTO_ROUTING ||
564 (protocol ==
UIP_PROTO_HBHO && opt_ptr->type == UIP_EXT_HDR_OPT_RPL)) {
566 *prev_proto_ptr = ext_ptr->next;
567 ext_len = ext_ptr->len * 8 + 8;
568 if(uipbuf_add_ext_hdr(-ext_len) ==
false) {
578 memmove(next_header, next_header + ext_len,
582 protocol = *prev_proto_ptr;
585 next_header = uipbuf_get_next_header(next_header,
588 if(next_header == NULL) {
592 ext_ptr = (
struct uip_ext_hdr *)next_header;
593 prev_proto_ptr = &ext_ptr->next;
int rpl_process_hbh(rpl_nbr_t *sender, uint16_t sender_rank, int loop_detected, int rank_error_signaled)
Processes Hop-by-Hop (HBH) Extension Header of a packet currently being forwrded.
int rpl_is_addr_in_our_dag(const uip_ipaddr_t *addr)
Tells whether a given global IPv6 address is in our current DAG.
uip_sr_node_t * uip_sr_get_node(const void *graph, const uip_ipaddr_t *addr)
Looks up for a source routing node from its IPv6 global address.
#define uip_is_addr_unspecified(a)
Is IPv6 address a the unspecified address a is of type uip_ipaddr_t.
int uip_sr_is_addr_reachable(const void *graph, const uip_ipaddr_t *addr)
Telle whether an address is reachable, i.e.
#define uip_is_addr_mcast(a)
is address a multicast address, see RFC 4291 a is of type uip_ipaddr_t*
#define uip_is_addr_linklocal(a)
is addr (a) a link local unicast address, see RFC 4291 i.e.
uip_ds6_netif_t uip_ds6_if
The single interface.
#define uip_is_addr_loopback(a)
Is IPv6 address a the unspecified address a is of type uip_ipaddr_t.
#define UIP_PROTO_HBHO
extension headers types
#define UIP_IP_BUF
Direct access to IPv6 header.
#define UIP_HTONS(n)
Convert 16-bit quantity from host byte order to network byte order.
#define uip_ipaddr_copy(dest, src)
Copy an IP address from one place to another.
#define uip_buf
Macro to access uip_aligned_buf as an array of bytes.
uint16_t uip_ext_len
The length of the extension headers.
uint16_t uip_len
The length of the packet in the uip_buf buffer.
#define UIP_BUFSIZE
The size of the uIP packet buffer.
#define UIP_LINK_MTU
The maximum transmission unit at the IP layer.
Header file for the logging system.
Header file for the Packet buffer (packetbuf) management.
Routing driver header file.
int(* get_sr_node_ipaddr)(uip_ipaddr_t *ipaddr, const uip_sr_node_t *node)
Returns the global IPv6 address of a source routing node.
All information related to a RPL neighbor.
A node in a source routing graph, stored at the root and representing all child-parent relationship.
static uip_ipaddr_t ipaddr
Pointer to prefix information option in uip_buf.