Cenk Gündoğan
8 years ago
12 changed files with 972 additions and 5 deletions
@ -0,0 +1,180 @@
|
||||
/*
|
||||
* Copyright (C) 2016 Cenk Gündoğan <mail@cgundogan.de> |
||||
* |
||||
* This file is subject to the terms and conditions of the GNU Lesser |
||||
* General Public License v2.1. See the file LICENSE in the top level |
||||
* directory for more details. |
||||
*/ |
||||
|
||||
/**
|
||||
* @defgroup net_rpl_p2p Reactive Discovery of P2P Routes in LLNs |
||||
* @ingroup net_gnrc_rpl |
||||
* @brief Implementation of P2P-RPL |
||||
* @see <a href="https://tools.ietf.org/html/rfc6997"> |
||||
* RFC 6997 |
||||
* </a> |
||||
* @{ |
||||
* |
||||
* @file |
||||
* @brief Definititions for P2P-RPL |
||||
* |
||||
* @author Cenk Gündoğan <mail@cgundogan.de> |
||||
*/ |
||||
#ifndef GNRC_RPL_P2P_H_ |
||||
#define GNRC_RPL_P2P_H_ |
||||
|
||||
#include "net/ipv6/addr.h" |
||||
#include "net/gnrc.h" |
||||
#include "net/gnrc/rpl/structs.h" |
||||
#include "net/gnrc/rpl/p2p_structs.h" |
||||
|
||||
#ifdef __cplusplus |
||||
extern "C" { |
||||
#endif |
||||
|
||||
/**
|
||||
* @brief P2P-RPL Mode of Operation |
||||
*/ |
||||
#define GNRC_RPL_P2P_MOP (0x04) |
||||
|
||||
/**
|
||||
* @brief Default lifetime of the P2P-RPL DODAG, encoded |
||||
* @see <a href="https://tools.ietf.org/html/rfc6997#section-7"> |
||||
* RFC 6997, section 7, P2P Route Discovery Option (P2P-RDO) |
||||
* </a> |
||||
*/ |
||||
#define GNRC_RPL_P2P_LIFETIME (0x02) |
||||
|
||||
/**
|
||||
* @brief Number of elided prefix octets from the target field and address vector |
||||
* @see <a href="https://tools.ietf.org/html/rfc6997#section-7"> |
||||
* RFC 6997, section 7, P2P Route Discovery Option (P2P-RDO) |
||||
* </a> |
||||
*/ |
||||
#define GNRC_RPL_P2P_COMPR (0) |
||||
|
||||
/**
|
||||
* @brief Maximum rank in the DODAG during the route discovery |
||||
* @see <a href="https://tools.ietf.org/html/rfc6997#section-7"> |
||||
* RFC 6997, section 7, P2P Route Discovery Option (P2P-RDO) |
||||
* </a> |
||||
*/ |
||||
#define GNRC_RPL_P2P_MAX_RANK (0) |
||||
|
||||
/**
|
||||
* @name Trickle parameters |
||||
* @see <a href="https://tools.ietf.org/html/rfc6997#section-6.1"> |
||||
* RFC 6997, section 6.1, Setting a P2P Mode DIO |
||||
* </a> |
||||
* @{ |
||||
*/ |
||||
#define GNRC_RPL_P2P_DEFAULT_DIO_INTERVAL_MIN (6) |
||||
#define GNRC_RPL_P2P_DEFAULT_DIO_REDUNDANCY_CONSTANT (1) |
||||
/** @} */ |
||||
|
||||
/**
|
||||
* @name Default parent and route entry lifetime |
||||
* default lifetime will be multiplied by the lifetime unit to obtain the resulting lifetime |
||||
* @{ |
||||
*/ |
||||
#define GNRC_RPL_P2P_DEFAULT_LIFETIME (0xFF) |
||||
#define GNRC_RPL_P2P_LIFETIME_UNIT (0xFFFF) |
||||
/** @} */ |
||||
|
||||
/**
|
||||
* @brief P2P-RPL RDO DIO option type |
||||
* @see <a href="https://tools.ietf.org/html/rfc6997#section-7"> |
||||
* RFC 6997, section 7, P2P Route Discovery Option (P2P-RDO) |
||||
* </a> |
||||
*/ |
||||
#define GNRC_RPL_P2P_OPT_RDO (0x0A) |
||||
|
||||
/**
|
||||
* @brief DRO ICMPv6 code |
||||
* @see <a href="https://tools.ietf.org/html/rfc6997#section-8"> |
||||
* RFC 6997, section 8, The P2P Discovery Reply Object (P2P-DRO) |
||||
* </a> |
||||
*/ |
||||
#define GNRC_RPL_P2P_ICMPV6_CODE_DRO (0x04) |
||||
|
||||
/**
|
||||
* @brief DRO-ACK ICMPv6 code |
||||
* @see <a href="https://tools.ietf.org/html/rfc6997#section-10"> |
||||
* RFC 6997, section 10, The P2P Discovery Reply Object Acknowledgement (P2P-DRO-ACK) |
||||
* </a> |
||||
*/ |
||||
#define GNRC_RPL_P2P_ICMPV6_CODE_DRO_ACK (0x05) |
||||
|
||||
/**
|
||||
* @brief Time in seconds to wait before sending a DRO |
||||
*/ |
||||
#define GNRC_RPL_P2P_DRO_DELAY (4) |
||||
|
||||
/**
|
||||
* @brief Message type for handling DRO sending |
||||
*/ |
||||
#define GNRC_RPL_P2P_MSG_TYPE_DRO_HANDLE (0x09A0) |
||||
|
||||
/**
|
||||
* @brief Lookup table used to decode/encode the lifetime values |
||||
*/ |
||||
extern const uint8_t gnrc_rpl_p2p_lifetime_lookup[4]; |
||||
|
||||
/**
|
||||
* @brief Initialization of a P2P-RPL Instance as root node. |
||||
* |
||||
* @param[in] instance_id Id of the instance |
||||
* @param[in] dodag_id Id of the DODAG |
||||
* @param[in] target Target of the P2P-RPL routes discovery |
||||
* @param[in] gen_inst_id Flag indicating whether to generate a local isntance id. |
||||
* If true, @p instance_id will be ignored |
||||
* |
||||
* @return Pointer to the new Instance, on success. |
||||
* @return NULL, otherwise. |
||||
*/ |
||||
gnrc_rpl_instance_t *gnrc_rpl_p2p_root_init(uint8_t instance_id, ipv6_addr_t *dodag_id, |
||||
ipv6_addr_t *target, bool gen_inst_id); |
||||
|
||||
/**
|
||||
* @brief Build an RDO |
||||
* |
||||
* @param[in,out] pkt The RDO will be added to the @p pkt |
||||
* @param[in] p2p_ext Pointer to the P2P-RPL DODAG extension |
||||
*/ |
||||
gnrc_pktsnip_t *gnrc_rpl_p2p_rdo_build(gnrc_pktsnip_t *pkt, gnrc_rpl_p2p_ext_t *p2p_ext); |
||||
|
||||
/**
|
||||
* @brief Parse an RDO |
||||
* |
||||
* @param[in] rdo The RDO to parse from. |
||||
* @param[in] p2p_ext Pointer to the P2P-RPL DODAG extension |
||||
*/ |
||||
void gnrc_rpl_p2p_rdo_parse(gnrc_rpl_p2p_opt_rdo_t *rdo, gnrc_rpl_p2p_ext_t *p2p_ext); |
||||
|
||||
/**
|
||||
* @brief Send a DRO control message |
||||
* |
||||
* @param[in] pkt The ICMPv6 packet to send. Can be NULL. |
||||
* @param[in] p2p_ext Pointer to the P2P-RPL DODAG extension |
||||
*/ |
||||
void gnrc_rpl_p2p_send_DRO(gnrc_pktsnip_t *pkt, gnrc_rpl_p2p_ext_t *p2p_ext); |
||||
|
||||
/**
|
||||
* @brief Receive and parse a DRO control message |
||||
* |
||||
* @param[in] pkt The ICMPv6 packet to parse. |
||||
* @param[in] src The source address of the IPv6 packet. |
||||
*/ |
||||
void gnrc_rpl_p2p_recv_DRO(gnrc_pktsnip_t *pkt, ipv6_addr_t *src); |
||||
|
||||
/**
|
||||
* @brief Updates the lifetime of the P2P Dodag and the delay of the DRO |
||||
*/ |
||||
void gnrc_rpl_p2p_update(void); |
||||
|
||||
#ifdef __cplusplus |
||||
} |
||||
#endif |
||||
|
||||
#endif /* GNRC_RPL_P2P_H_ */ |
||||
/** @} */ |
||||
@ -0,0 +1,74 @@
|
||||
/*
|
||||
* Copyright (C) 2016 Cenk Gündoğan <mail@cgundogan.de> |
||||
* |
||||
* This file is subject to the terms and conditions of the GNU Lesser |
||||
* General Public License v2.1. See the file LICENSE in the top level |
||||
* directory for more details. |
||||
*/ |
||||
|
||||
/**
|
||||
* @ingroup net_gnrc_rpl_p2p |
||||
* @{ |
||||
* |
||||
* @file |
||||
* @brief DODAG-related functions for P2P-RPL |
||||
* |
||||
* Header file, which defines all public known DODAG-related functions for P2P-RPL. |
||||
* |
||||
* @author Cenk Gündoğan <mail@cgundogan.de> |
||||
*/ |
||||
|
||||
#ifndef GNRC_RPL_P2P_DODAG_H_ |
||||
#define GNRC_RPL_P2P_DODAG_H_ |
||||
|
||||
#ifdef __cplusplus |
||||
extern "C" { |
||||
#endif |
||||
|
||||
#include "net/gnrc/rpl/p2p_structs.h" |
||||
|
||||
/**
|
||||
* @brief Number of P2P RPL DODAG extensions |
||||
*/ |
||||
#ifndef GNRC_RPL_P2P_EXTS_NUMOF |
||||
#define GNRC_RPL_P2P_EXTS_NUMOF (1) |
||||
#endif |
||||
|
||||
/**
|
||||
* @brief P2P-RPL DODAG extensions table |
||||
*/ |
||||
extern gnrc_rpl_p2p_ext_t gnrc_rpl_p2p_exts[GNRC_RPL_P2P_EXTS_NUMOF]; |
||||
|
||||
/**
|
||||
* @brief Allocate a free P2P-RPL DODAG extension |
||||
* |
||||
* @return Pointer to a free P2P-RPL DODAG extension |
||||
* @return NULL, if no free P2P-RPL DODAG extension is available |
||||
*/ |
||||
gnrc_rpl_p2p_ext_t *gnrc_rpl_p2p_ext_new(gnrc_rpl_dodag_t *dodag); |
||||
|
||||
/**
|
||||
* @brief Free the P2P-RPL DODAG extension of @p dodag |
||||
* |
||||
* @param[in] dodag Pointer to a P2P-RPL DODAG |
||||
*/ |
||||
void gnrc_rpl_p2p_ext_remove(gnrc_rpl_dodag_t *dodag); |
||||
|
||||
/**
|
||||
* @brief Get the appropriate P2P-RPL DODAG extension of the @p dodag |
||||
* |
||||
* @param[in] dodag Pointer to a P2P-RPL DODAG |
||||
* |
||||
* @return Pointer to a P2P-RPL DODAG extension |
||||
* @return NULL, if no P2P-RPL DODAG extension is available for @p dodag |
||||
*/ |
||||
gnrc_rpl_p2p_ext_t *gnrc_rpl_p2p_ext_get(gnrc_rpl_dodag_t *dodag); |
||||
|
||||
#ifdef __cplusplus |
||||
} |
||||
#endif |
||||
|
||||
#endif /* GNRC_RPL_P2P_DODAG_H_ */ |
||||
/**
|
||||
* @} |
||||
*/ |
||||
@ -0,0 +1,106 @@
|
||||
/*
|
||||
* Copyright (C) 2016 Cenk Gündoğan <mail@cgundogan.de> |
||||
* |
||||
* This file is subject to the terms and conditions of the GNU Lesser |
||||
* General Public License v2.1. See the file LICENSE in the top level |
||||
* directory for more details. |
||||
*/ |
||||
|
||||
/**
|
||||
* @ingroup net_gnrc_rpl_p2p |
||||
* @{ |
||||
* |
||||
* @file |
||||
* @brief P2P-RPL data structs |
||||
* |
||||
* Header file, which defines all structs used by P2P-RPL. |
||||
* |
||||
* @author Cenk Gündoğan <mail@cgundogan.de> |
||||
*/ |
||||
|
||||
#ifndef GNRC_RPL_P2P_STRUCTS_H_ |
||||
#define GNRC_RPL_P2P_STRUCTS_H_ |
||||
|
||||
#ifdef __cplusplus |
||||
extern "C" { |
||||
#endif |
||||
|
||||
#include "net/ipv6/addr.h" |
||||
#include "net/gnrc/rpl/structs.h" |
||||
|
||||
/**
|
||||
* @brief Address vector length in RDO DIO options and maximal hop count for the P2P-DODAG |
||||
*/ |
||||
#define GNRC_RPL_P2P_ADDR_VEC_NUMOF (8) |
||||
|
||||
/**
|
||||
* @brief P2P Route Discovery Object (RDO) Option |
||||
* @see <a href="https://tools.ietf.org/html/rfc6997#section-7"> |
||||
* RFC 6997, section 7, P2P Route Discovery Option (P2P-RDO) |
||||
* </a> |
||||
*/ |
||||
typedef struct __attribute__((packed)) { |
||||
uint8_t type; /**< Option Type: 0x0a */ |
||||
uint8_t length; /**< length of option, not including first two bytes */ |
||||
uint8_t compr_flags; /**< flags and number of elided prefix octets */ |
||||
uint8_t lmn; /**< lifetime, maxrank/nexthop */ |
||||
ipv6_addr_t target; /**< target address */ |
||||
} gnrc_rpl_p2p_opt_rdo_t; |
||||
|
||||
/**
|
||||
* @brief P2P Discovery Reply Object (P2P-DRO) |
||||
* @see <a href="https://tools.ietf.org/html/rfc6997#section-8"> |
||||
* RFC 6997, section 8, P2P Discovery Reply Object (P2P-DRO) |
||||
* </a> |
||||
*/ |
||||
typedef struct __attribute__((packed)) { |
||||
uint8_t instance_id; /**< id of the instance */ |
||||
uint8_t version_number; /**< version number of the DODAG */ |
||||
network_uint16_t flags_rev; /**< flags and reserved */ |
||||
ipv6_addr_t dodag_id; /**< id of the dodag */ |
||||
} gnrc_rpl_p2p_dro_t; |
||||
|
||||
/**
|
||||
* @brief P2P Discovery Reply Object Acknowledgement (P2P-DRO-ACK) |
||||
* @see <a href="https://tools.ietf.org/html/rfc6997#section-10"> |
||||
* RFC 6997, section 10, P2P Discovery Reply Object Acknowledgement (P2P-DRO-ACK) |
||||
* </a> |
||||
*/ |
||||
typedef struct __attribute__((packed)) { |
||||
uint8_t instance_id; /**< id of the instance */ |
||||
uint8_t version_number; /**< version number of the DODAG */ |
||||
network_uint16_t seq_rev; /**< sequence number and reserved */ |
||||
ipv6_addr_t dodag_id; /**< id of the dodag */ |
||||
} gnrc_rpl_p2p_dro_ack_t; |
||||
|
||||
/**
|
||||
* @brief Extended DODAG information for P2P-RPL |
||||
*/ |
||||
typedef struct { |
||||
bool state; /**< state: used / unused */ |
||||
gnrc_rpl_dodag_t *dodag;/**< DODAG, which owns this P2P extension */ |
||||
uint8_t compr; /**< number of elided prefix octets */ |
||||
uint8_t routes_numof; /**< number of requested routes */ |
||||
bool hop_by_hop; /**< request hop-by-hop routes or source routes */ |
||||
bool stop; /**< stop route discovery */ |
||||
bool reply; /**< request P2P-DRO */ |
||||
bool dro_ack; /**< request P2P-DRO-ACK */ |
||||
uint8_t lifetime_enc; /**< encoded lifetime of the P2P-DODAG */ |
||||
int8_t lifetime_sec; /**< lifetime of the P2P-DODAG in seconds */ |
||||
uint8_t maxrank; /**< maximum rank the P2P-DODAG should span */ |
||||
uint8_t dro_seq; /**< sequence number of the P2P-DRO */ |
||||
ipv6_addr_t target; /**< target of the P2P route discovery */ |
||||
bool for_me; /**< true if this node is the target */ |
||||
uint8_t addr_numof; /**< number of addresses in the address vector */ |
||||
int8_t dro_delay; /**< delay DRO after it was requested in seconds */ |
||||
ipv6_addr_t addr_vec[GNRC_RPL_P2P_ADDR_VEC_NUMOF]; /**< address vector */ |
||||
} gnrc_rpl_p2p_ext_t; |
||||
|
||||
#ifdef __cplusplus |
||||
} |
||||
#endif |
||||
|
||||
#endif /* GNRC_RPL_P2P_STRUCTS_H_ */ |
||||
/**
|
||||
* @} |
||||
*/ |
||||
@ -0,0 +1,3 @@
|
||||
MODULE = gnrc_rpl_p2p
|
||||
|
||||
include $(RIOTBASE)/Makefile.base |
||||
@ -0,0 +1,386 @@
|
||||
/*
|
||||
* Copyright (C) 2016 Cenk Gündoğan <mail@cgundogan.de> |
||||
* |
||||
* This file is subject to the terms and conditions of the GNU Lesser |
||||
* General Public License v2.1. See the file LICENSE in the top level |
||||
* directory for more details. |
||||
*/ |
||||
|
||||
/**
|
||||
* @{ |
||||
* |
||||
* @file |
||||
* |
||||
* @author Cenk Gündoğan <mail@cgundogan.de> |
||||
*/ |
||||
|
||||
#include "net/icmpv6.h" |
||||
#include "net/gnrc/ipv6.h" |
||||
#include "net/gnrc/icmpv6.h" |
||||
#include "net/gnrc.h" |
||||
#include "net/gnrc/rpl/structs.h" |
||||
#include "net/gnrc/rpl/dodag.h" |
||||
#include "net/gnrc/rpl/p2p.h" |
||||
#include "net/gnrc/rpl/p2p_structs.h" |
||||
#include "net/gnrc/rpl/p2p_dodag.h" |
||||
|
||||
#define ENABLE_DEBUG (0) |
||||
#include "debug.h" |
||||
|
||||
#if ENABLE_DEBUG |
||||
static char addr_str[IPV6_ADDR_MAX_STR_LEN]; |
||||
#endif |
||||
|
||||
#define GNRC_RPL_P2P_RDO_LEN (18) |
||||
#define GNRC_RPL_P2P_RDO_FLAGS_LIFETIME (6) |
||||
#define GNRC_RPL_P2P_RDO_FLAGS_HBH (6) |
||||
#define GNRC_RPL_P2P_RDO_FLAGS_REPLY (7) |
||||
#define GNRC_RPL_P2P_RDO_FLAGS_ADDRNUM (4) |
||||
#define GNRC_RPL_P2P_RDO_FLAGS_COMPR (0x0F) |
||||
#define GNRC_RPL_P2P_RDO_FLAGS_MAXRANK (0x3F) |
||||
#define GNRC_RPL_P2P_RDO_FLAGS_NEXT_HOP (GNRC_RPL_P2P_RDO_FLAGS_MAXRANK) |
||||
#define GNRC_RPL_P2P_DRO_FLAGS_SEQ (12) |
||||
#define GNRC_RPL_P2P_DRO_FLAGS_ACK (14) |
||||
#define GNRC_RPL_P2P_DRO_FLAGS_STOP (15) |
||||
|
||||
gnrc_rpl_p2p_ext_t gnrc_rpl_p2p_exts[GNRC_RPL_P2P_EXTS_NUMOF]; |
||||
const uint8_t gnrc_rpl_p2p_lifetime_lookup[4] = { 1, 4, 16, 64 }; |
||||
|
||||
void gnrc_rpl_p2p_update(void) |
||||
{ |
||||
gnrc_rpl_p2p_ext_t *p2p_ext; |
||||
for (uint8_t i = 0; i < GNRC_RPL_P2P_EXTS_NUMOF; ++i) { |
||||
p2p_ext = &gnrc_rpl_p2p_exts[i]; |
||||
if ((p2p_ext->state) && (p2p_ext->lifetime_sec > 0)) { |
||||
p2p_ext->lifetime_sec -= GNRC_RPL_LIFETIME_UPDATE_STEP; |
||||
if (p2p_ext->lifetime_sec <= 0) { |
||||
gnrc_rpl_dodag_remove_all_parents(p2p_ext->dodag); |
||||
p2p_ext->dodag->instance->cleanup = GNRC_RPL_CLEANUP_TIME; |
||||
continue; |
||||
} |
||||
p2p_ext->dro_delay -= GNRC_RPL_LIFETIME_UPDATE_STEP; |
||||
if (p2p_ext->reply && (p2p_ext->dro_delay < 0) && (p2p_ext->for_me)) { |
||||
gnrc_rpl_p2p_send_DRO(NULL, p2p_ext); |
||||
} |
||||
} |
||||
} |
||||
} |
||||
|
||||
gnrc_rpl_instance_t *gnrc_rpl_p2p_root_init(uint8_t instance_id, ipv6_addr_t *dodag_id, |
||||
ipv6_addr_t *target, bool gen_inst_id) |
||||
{ |
||||
if (gen_inst_id) { |
||||
instance_id = gnrc_rpl_gen_instance_id(true); |
||||
} |
||||
|
||||
gnrc_rpl_dodag_t *dodag = NULL; |
||||
gnrc_rpl_instance_t *instance = gnrc_rpl_root_instance_init(instance_id, dodag_id, |
||||
GNRC_RPL_P2P_MOP); |
||||
|
||||
if (!instance) { |
||||
return NULL; |
||||
} |
||||
|
||||
dodag = &instance->dodag; |
||||
|
||||
instance->max_rank_inc = 0; |
||||
dodag->dtsn = 0; |
||||
dodag->prf = 0; |
||||
dodag->dio_interval_doubl = GNRC_RPL_DEFAULT_DIO_INTERVAL_DOUBLINGS; |
||||
dodag->dio_min = GNRC_RPL_P2P_DEFAULT_DIO_INTERVAL_MIN; |
||||
dodag->dio_redun = GNRC_RPL_P2P_DEFAULT_DIO_REDUNDANCY_CONSTANT; |
||||
dodag->default_lifetime = GNRC_RPL_P2P_DEFAULT_LIFETIME; |
||||
dodag->lifetime_unit = GNRC_RPL_P2P_LIFETIME_UNIT; |
||||
dodag->version = 0; |
||||
dodag->grounded = 1; |
||||
dodag->node_status = GNRC_RPL_ROOT_NODE; |
||||
dodag->my_rank = GNRC_RPL_ROOT_RANK; |
||||
dodag->dio_opts |= GNRC_RPL_REQ_DIO_OPT_DODAG_CONF; |
||||
dodag->dio_opts &= ~GNRC_RPL_REQ_DIO_OPT_PREFIX_INFO; |
||||
|
||||
gnrc_rpl_p2p_ext_t *p2p_ext = gnrc_rpl_p2p_ext_get(dodag); |
||||
p2p_ext->target = *target; |
||||
p2p_ext->compr = GNRC_RPL_P2P_COMPR; |
||||
p2p_ext->routes_numof = 0; |
||||
p2p_ext->hop_by_hop = true; |
||||
p2p_ext->reply = true; |
||||
p2p_ext->lifetime_enc = GNRC_RPL_P2P_LIFETIME; |
||||
p2p_ext->lifetime_sec = gnrc_rpl_p2p_lifetime_lookup[p2p_ext->lifetime_enc]; |
||||
p2p_ext->maxrank = GNRC_RPL_P2P_MAX_RANK; |
||||
p2p_ext->dro_delay = -1; |
||||
|
||||
trickle_start(gnrc_rpl_pid, &dodag->trickle, GNRC_RPL_MSG_TYPE_TRICKLE_INTERVAL, |
||||
GNRC_RPL_MSG_TYPE_TRICKLE_CALLBACK, (1 << dodag->dio_min), |
||||
dodag->dio_interval_doubl, dodag->dio_redun); |
||||
|
||||
return instance; |
||||
} |
||||
|
||||
gnrc_pktsnip_t *gnrc_rpl_p2p_rdo_build(gnrc_pktsnip_t *pkt, gnrc_rpl_p2p_ext_t *p2p_ext) |
||||
{ |
||||
gnrc_rpl_p2p_opt_rdo_t *rdo; |
||||
gnrc_pktsnip_t *opt_snip; |
||||
size_t addr_len = (sizeof(ipv6_addr_t) - p2p_ext->compr); |
||||
for (uint8_t i = p2p_ext->addr_numof; i > 0; i--) { |
||||
if ((opt_snip = gnrc_pktbuf_add(pkt, NULL, addr_len, GNRC_NETTYPE_UNDEF)) == NULL) { |
||||
DEBUG("RPL: BUILD RDO - no space left in packet buffer\n"); |
||||
gnrc_pktbuf_release(pkt); |
||||
return NULL; |
||||
} |
||||
memcpy(opt_snip->data, &p2p_ext->addr_vec[i-1], addr_len); |
||||
pkt = opt_snip; |
||||
} |
||||
|
||||
if ((opt_snip = gnrc_pktbuf_add(pkt, NULL, sizeof(gnrc_rpl_p2p_opt_rdo_t), |
||||
GNRC_NETTYPE_UNDEF)) == NULL) { |
||||
DEBUG("RPL: BUILD RDO - no space left in packet buffer\n"); |
||||
gnrc_pktbuf_release(pkt); |
||||
return NULL; |
||||
} |
||||
rdo = opt_snip->data; |
||||
rdo->type = GNRC_RPL_P2P_OPT_RDO; |
||||
rdo->length = GNRC_RPL_P2P_RDO_LEN + |
||||
p2p_ext->addr_numof * (sizeof(ipv6_addr_t) - p2p_ext->compr); |
||||
rdo->compr_flags = (p2p_ext->reply << GNRC_RPL_P2P_RDO_FLAGS_REPLY) | |
||||
(p2p_ext->hop_by_hop << GNRC_RPL_P2P_RDO_FLAGS_HBH) |
||||
| ((p2p_ext->routes_numof & 0x3) << GNRC_RPL_P2P_RDO_FLAGS_ADDRNUM) |
||||
| (p2p_ext->compr & GNRC_RPL_P2P_RDO_FLAGS_COMPR); |
||||
rdo->lmn = ((p2p_ext->lifetime_enc & 0x3) << GNRC_RPL_P2P_RDO_FLAGS_LIFETIME) | |
||||
(p2p_ext->maxrank & GNRC_RPL_P2P_RDO_FLAGS_MAXRANK); |
||||
rdo->target = p2p_ext->target; |
||||
return opt_snip; |
||||
} |
||||
|
||||
void gnrc_rpl_p2p_rdo_parse(gnrc_rpl_p2p_opt_rdo_t *rdo, gnrc_rpl_p2p_ext_t *p2p_ext) |
||||
{ |
||||
DEBUG("RPL: Route Discovery DIO option parsed\n"); |
||||
|
||||
uint8_t addr_num = (rdo->length - GNRC_RPL_P2P_RDO_LEN) |
||||
/ (sizeof(ipv6_addr_t) - p2p_ext->compr); |
||||
if (addr_num >= GNRC_RPL_P2P_ADDR_VEC_NUMOF) { |
||||
DEBUG("RPL: cannot parse RDO - too many hops\n"); |
||||
return; |
||||
} |
||||
|
||||
p2p_ext->for_me = (gnrc_ipv6_netif_find_by_addr(NULL, &rdo->target) != KERNEL_PID_UNDEF); |
||||
|
||||
p2p_ext->reply = (rdo->compr_flags & (1 << GNRC_RPL_P2P_RDO_FLAGS_REPLY)) |
||||
>> GNRC_RPL_P2P_RDO_FLAGS_REPLY; |
||||
p2p_ext->hop_by_hop = (rdo->compr_flags & (1 << GNRC_RPL_P2P_RDO_FLAGS_HBH)) |
||||
>> GNRC_RPL_P2P_RDO_FLAGS_HBH; |
||||
p2p_ext->routes_numof = (rdo->compr_flags & (0x3 << GNRC_RPL_P2P_RDO_FLAGS_ADDRNUM)) |
||||
>> GNRC_RPL_P2P_RDO_FLAGS_ADDRNUM; |
||||
p2p_ext->compr = rdo->compr_flags & GNRC_RPL_P2P_RDO_FLAGS_COMPR; |
||||
p2p_ext->lifetime_enc = (rdo->lmn & (0x3 << GNRC_RPL_P2P_RDO_FLAGS_LIFETIME)) |
||||
>> GNRC_RPL_P2P_RDO_FLAGS_LIFETIME; |
||||
if (p2p_ext->lifetime_sec == INT8_MIN) { |
||||
p2p_ext->lifetime_sec = gnrc_rpl_p2p_lifetime_lookup[p2p_ext->lifetime_enc]; |
||||
} |
||||
p2p_ext->maxrank = rdo->lmn & GNRC_RPL_P2P_RDO_FLAGS_MAXRANK; |
||||
p2p_ext->target = rdo->target; |
||||
|
||||
memset(&p2p_ext->addr_vec, 0, sizeof(ipv6_addr_t) * GNRC_RPL_P2P_ADDR_VEC_NUMOF); |
||||
p2p_ext->addr_numof = 0; |
||||
uint8_t *tmp = (uint8_t *) (rdo + 1); |
||||
uint8_t *addr = NULL; |
||||
uint8_t addr_len = sizeof(ipv6_addr_t) - p2p_ext->compr; |
||||
uint8_t i = 0; |
||||
for (i = 0; i < addr_num; i++) { |
||||
addr = ((uint8_t *) &p2p_ext->addr_vec[i]) + p2p_ext->compr; |
||||
memcpy(addr, tmp, addr_len); |
||||
tmp += addr_len; |
||||
p2p_ext->addr_numof++; |
||||
} |
||||
|
||||
if (!p2p_ext->for_me) { |
||||
ipv6_addr_t *me = NULL; |
||||
if(gnrc_ipv6_netif_find_by_prefix(&me, &p2p_ext->dodag->dodag_id) == KERNEL_PID_UNDEF) { |
||||
DEBUG("RPL: no address configured\n"); |
||||
return; |
||||
} |
||||
addr = ((uint8_t *) &p2p_ext->addr_vec[i]) + p2p_ext->compr; |
||||
memcpy(addr, ((uint8_t *) me) + p2p_ext->compr, addr_len); |
||||
p2p_ext->addr_numof++; |
||||
} |
||||
else if (p2p_ext->reply) { |
||||
p2p_ext->stop = true; |
||||
p2p_ext->dro_ack = true; |
||||
p2p_ext->dro_delay = GNRC_RPL_P2P_DRO_DELAY; |
||||
} |
||||
} |
||||
|
||||
static gnrc_pktsnip_t *_build_initial_DRO(gnrc_rpl_p2p_ext_t *p2p_ext) |
||||
{ |
||||
gnrc_pktsnip_t *pkt = NULL, *opt_snip = NULL; |
||||
gnrc_rpl_p2p_dro_t *dro = NULL; |
||||
gnrc_rpl_p2p_opt_rdo_t *rdo = NULL; |
||||
size_t addr_len = (sizeof(ipv6_addr_t) - p2p_ext->compr); |
||||
uint8_t addr_size = p2p_ext->addr_numof * addr_len; |
||||
|
||||
for (uint8_t i = p2p_ext->addr_numof; i > 0; i--) { |
||||
if ((opt_snip = gnrc_pktbuf_add(pkt, NULL, addr_len, GNRC_NETTYPE_UNDEF)) == NULL) { |
||||
DEBUG("RPL-P2P: cannot add addresses to RDO - no space left in packet buffer\n"); |
||||
gnrc_pktbuf_release(pkt); |
||||
return NULL; |
||||
} |
||||
memcpy(opt_snip->data, &p2p_ext->addr_vec[i-1], addr_len); |
||||
pkt = opt_snip; |
||||
} |
||||
|
||||
if ((opt_snip = gnrc_pktbuf_add(pkt, NULL, sizeof(gnrc_rpl_p2p_opt_rdo_t), |
||||
GNRC_NETTYPE_UNDEF)) == NULL) { |
||||
DEBUG("RPL-P2P: cannot allocate DRO - no space left in packet buffer\n"); |
||||
gnrc_pktbuf_release(pkt); |
||||
return NULL; |
||||
} |
||||
|
||||
rdo = opt_snip->data; |
||||
rdo->type = GNRC_RPL_P2P_OPT_RDO; |
||||
rdo->length = GNRC_RPL_P2P_RDO_LEN + addr_size; |
||||
rdo->compr_flags = (p2p_ext->hop_by_hop << GNRC_RPL_P2P_RDO_FLAGS_HBH) | |
||||
(p2p_ext->compr & GNRC_RPL_P2P_RDO_FLAGS_COMPR); |
||||
/* rdo->length does not include the first two bytes, thus we have to add them manually */ |
||||
rdo->lmn = (((rdo->length + 2 - sizeof(*rdo)) / addr_len) & GNRC_RPL_P2P_RDO_FLAGS_NEXT_HOP); |
||||
rdo->target = p2p_ext->target; |
||||
pkt = opt_snip; |
||||
|
||||
if ((opt_snip = gnrc_pktbuf_add(pkt, NULL, sizeof(gnrc_rpl_p2p_dro_t), |
||||
GNRC_NETTYPE_UNDEF)) == NULL) { |
||||
DEBUG("RPL-P2P: cannot allocate RDO - no space left in packet buffer\n"); |
||||
gnrc_pktbuf_release(pkt); |
||||
return NULL; |
||||
} |
||||
dro = opt_snip->data; |
||||
dro->instance_id = p2p_ext->dodag->instance->id; |
||||
dro->version_number = 0; |
||||
dro->flags_rev = byteorder_htons((((p2p_ext->stop << 1) | (p2p_ext->dro_ack << 0)) |
||||
<< GNRC_RPL_P2P_DRO_FLAGS_ACK) | |
||||
((p2p_ext->dro_seq & 0x3) << GNRC_RPL_P2P_DRO_FLAGS_SEQ)); |
||||
dro->dodag_id = p2p_ext->dodag->dodag_id; |
||||
pkt = opt_snip; |
||||
|
||||
if ((opt_snip = gnrc_icmpv6_build(pkt, ICMPV6_RPL_CTRL, GNRC_RPL_P2P_ICMPV6_CODE_DRO, |
||||
sizeof(icmpv6_hdr_t))) == NULL) { |
||||
DEBUG("RPL-P2P: cannot allocate ICMPv6 - no space left in packet buffer\n"); |
||||
gnrc_pktbuf_release(pkt); |
||||
return NULL; |
||||
} |
||||
|
||||
pkt = opt_snip; |
||||
|
||||
return pkt; |
||||
} |
||||
|
||||
void gnrc_rpl_p2p_send_DRO(gnrc_pktsnip_t *pkt, gnrc_rpl_p2p_ext_t *p2p_ext) |
||||
{ |
||||
assert(p2p_ext != NULL); |
||||
|
||||
if (pkt == NULL) { |
||||
if ((pkt = _build_initial_DRO(p2p_ext)) == NULL) { |
||||
DEBUG("RPL-P2P: BUILD INITIAL DRO - no space left in packet buffer\n"); |
||||
return; |
||||
} |
||||
} |
||||
|
||||
gnrc_rpl_send(pkt, p2p_ext->dodag->iface, NULL, NULL, &p2p_ext->dodag->dodag_id); |
||||
|
||||
return; |
||||
} |
||||
|
||||
void gnrc_rpl_p2p_recv_DRO(gnrc_pktsnip_t *pkt, ipv6_addr_t *src) |
||||
{ |
||||
gnrc_pktsnip_t *icmpv6_snip = gnrc_pktbuf_mark(pkt, sizeof(icmpv6_hdr_t), GNRC_NETTYPE_ICMPV6); |
||||
gnrc_pktsnip_t *dro_snip = gnrc_pktbuf_mark(pkt, sizeof(gnrc_rpl_p2p_dro_t), |
||||
GNRC_NETTYPE_UNDEF); |
||||
gnrc_pktsnip_t *rdo_snip = gnrc_pktbuf_mark(pkt, sizeof(gnrc_rpl_p2p_opt_rdo_t), |
||||
GNRC_NETTYPE_UNDEF); |
||||
gnrc_pktsnip_t *addr_snip = pkt; |
||||
gnrc_rpl_instance_t *inst; |
||||
gnrc_rpl_dodag_t *dodag; |
||||
gnrc_rpl_p2p_ext_t *p2p_ext; |
||||
gnrc_rpl_p2p_dro_t *dro; |
||||
gnrc_rpl_p2p_opt_rdo_t *rdo; |
||||
uint8_t *addr_vec; |
||||
uint16_t flags; |
||||
size_t addr_len; |
||||
|
||||
if (!rdo_snip || !dro_snip) { |
||||
DEBUG("RPL-P2P: Error - No DRO or RDO received\n"); |
||||
gnrc_pktbuf_release(pkt); |
||||
return; |
||||
} |
||||
|
||||
dro = dro_snip->data; |
||||
|
||||
if ((inst = gnrc_rpl_instance_get(dro->instance_id)) == NULL) { |
||||
DEBUG("RPL-P2P: Error - Instance (%d) does not exist\n", dro->instance_id); |
||||
return; |
||||
} |
||||
|
||||
dodag = &inst->dodag; |
||||
|
||||
if ((p2p_ext = gnrc_rpl_p2p_ext_get(dodag)) == NULL) { |
||||
DEBUG("RPL-P2P: Error - No P2P-RPL DODAG extension found\n"); |
||||
return; |
||||
} |
||||
|
||||
if (p2p_ext->for_me) { |
||||
DEBUG("RPL-P2P: Ignore DRO\n"); |
||||
return; |
||||
} |
||||
|
||||
flags = byteorder_ntohs(dro->flags_rev); |
||||
p2p_ext->stop = (flags & (1 << GNRC_RPL_P2P_DRO_FLAGS_STOP)) >> GNRC_RPL_P2P_DRO_FLAGS_STOP; |
||||
p2p_ext->dro_ack = (flags & (1 << GNRC_RPL_P2P_DRO_FLAGS_ACK)) >> GNRC_RPL_P2P_DRO_FLAGS_ACK; |
||||
p2p_ext->dro_seq = (flags & (0x3 << GNRC_RPL_P2P_DRO_FLAGS_SEQ)) >> GNRC_RPL_P2P_DRO_FLAGS_SEQ; |
||||
|
||||
addr_len = sizeof(ipv6_addr_t) - p2p_ext->compr; |
||||
ipv6_addr_t addr = p2p_ext->dodag->dodag_id; |
||||
ipv6_addr_t *me = NULL; |
||||
addr_vec = addr_snip->data; |
||||
|
||||
rdo = rdo_snip->data; |
||||
|
||||
if (rdo->lmn > 0) { |
||||
rdo->lmn--; |
||||
memcpy(&addr.u8[p2p_ext->compr], &addr_vec[addr_len * rdo->lmn], addr_len); |
||||
} |
||||
|
||||
if (gnrc_ipv6_netif_find_by_addr(&me, &addr) == dodag->iface) { |
||||
fib_add_entry(&gnrc_ipv6_fib_table, dodag->iface, p2p_ext->target.u8, |
||||
sizeof(ipv6_addr_t), FIB_FLAG_NET_PREFIX, src->u8, |
||||
sizeof(ipv6_addr_t), FIB_FLAG_RPL_ROUTE, |
||||
p2p_ext->dodag->default_lifetime * |
||||
p2p_ext->dodag->lifetime_unit * SEC_IN_MS); |
||||
|
||||
if (p2p_ext->dodag->node_status != GNRC_RPL_ROOT_NODE) { |
||||
if ((rdo_snip = gnrc_pktbuf_start_write(rdo_snip)) == NULL) { |
||||
DEBUG("RPL-P2P: Error - Cannot allocate new RDO\n"); |
||||
return; |
||||
} |
||||
|
||||
addr_snip->next = NULL; |
||||
rdo_snip->next = addr_snip; |
||||
dro_snip->next = rdo_snip; |
||||
|
||||
icmpv6_snip = gnrc_icmpv6_build(dro_snip, ICMPV6_RPL_CTRL, GNRC_RPL_P2P_ICMPV6_CODE_DRO, |
||||
sizeof(icmpv6_hdr_t)); |
||||
if (icmpv6_snip == NULL) { |
||||
DEBUG("RPL-P2P: cannot allocate ICMPv6 - no space left in packet buffer\n"); |
||||
gnrc_pktbuf_release(pkt); |
||||
return; |
||||
} |
||||
|
||||
gnrc_rpl_send(icmpv6_snip, p2p_ext->dodag->iface, NULL, NULL, &p2p_ext->dodag->dodag_id); |
||||
return; |
||||
} |
||||
} |
||||
|
||||
gnrc_pktbuf_release(pkt); |
||||
|
||||
return; |
||||
} |
||||
|
||||
/**
|
||||
* @} |
||||
*/ |
||||
@ -0,0 +1,63 @@
|
||||
/**
|
||||
* Copyright (C) 2016 Cenk Gündoğan <mail@cgundogan.de> |
||||
* |
||||
* This file is subject to the terms and conditions of the GNU Lesser |
||||
* General Public License v2.1. See the file LICENSE in the top level |
||||
* directory for more details. |
||||
*/ |
||||
|
||||
/**
|
||||
* @{ |
||||
* |
||||
* @file |
||||
* @author Cenk Gündoğan <mail@cgundogan.de> |
||||
*/ |
||||
|
||||
#include <string.h> |
||||
#include "net/gnrc/rpl/structs.h" |
||||
#include "net/gnrc/rpl/p2p.h" |
||||
#include "net/gnrc/rpl/p2p_dodag.h" |
||||
#include "net/gnrc/rpl/p2p_structs.h" |
||||
|
||||
#define ENABLE_DEBUG (0) |
||||
#include "debug.h" |
||||
|
||||
gnrc_rpl_p2p_ext_t *gnrc_rpl_p2p_ext_new(gnrc_rpl_dodag_t *dodag) |
||||
{ |
||||
for (uint8_t i = 0; i < GNRC_RPL_P2P_EXTS_NUMOF; ++i) { |
||||
if (!gnrc_rpl_p2p_exts[i].state) { |
||||
gnrc_rpl_p2p_exts[i].state = true; |
||||
gnrc_rpl_p2p_exts[i].dodag = dodag; |
||||
gnrc_rpl_p2p_exts[i].dro_delay = -1; |
||||
gnrc_rpl_p2p_exts[i].lifetime_sec = INT8_MIN; |
||||
return &gnrc_rpl_p2p_exts[i]; |
||||
} |
||||
} |
||||
|
||||
/* no space available to allocate a P2P-RPL DODAG extension */ |
||||
DEBUG("RPL-P2P: Could not a new P2P-RPL DODAG extension\n"); |
||||
return NULL; |
||||
} |
||||
|
||||
void gnrc_rpl_p2p_ext_remove(gnrc_rpl_dodag_t *dodag) |
||||
{ |
||||
for (uint8_t i = 0; i < GNRC_RPL_P2P_EXTS_NUMOF; ++i) { |
||||
if ((gnrc_rpl_p2p_exts[i].state) && (gnrc_rpl_p2p_exts[i].dodag == dodag)) { |
||||
memset(&gnrc_rpl_p2p_exts[i], 0, sizeof(gnrc_rpl_p2p_ext_t)); |
||||
return; |
||||
} |
||||
} |
||||
} |
||||
|
||||
gnrc_rpl_p2p_ext_t *gnrc_rpl_p2p_ext_get(gnrc_rpl_dodag_t *dodag) |
||||
{ |
||||
for (uint8_t i = 0; i < GNRC_RPL_P2P_EXTS_NUMOF; ++i) { |
||||
if ((gnrc_rpl_p2p_exts[i].state) && (gnrc_rpl_p2p_exts[i].dodag == dodag)) { |
||||
return &gnrc_rpl_p2p_exts[i]; |
||||
} |
||||
} |
||||
return NULL; |
||||
} |
||||
/**
|
||||
* @} |
||||
*/ |
||||
Loading…
Reference in new issue