946be77248
This is a fix for Contiki RPL so that it fully supports DAO ACK in an end-to-end fashion. When DAO is sent it will be forwarded upwards as before. DAO ACK will be forwarded downwards until it reach the node that initiated the DAO ACK and unlike before it is not a single-hop DAO ACK but it is fully reaching the RPL ROOT before any DAO ACK is sent back. DAO ACK also now fully support different status messages (success / fail).
312 lines
9 KiB
C
312 lines
9 KiB
C
/*
|
|
* Copyright (c) 2010, Swedish Institute of Computer Science.
|
|
* All rights reserved.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
* 3. Neither the name of the Institute nor the names of its contributors
|
|
* may be used to endorse or promote products derived from this software
|
|
* without specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE INSTITUTE AND CONTRIBUTORS ``AS IS'' AND
|
|
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
|
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
|
* ARE DISCLAIMED. IN NO EVENT SHALL THE INSTITUTE OR CONTRIBUTORS BE LIABLE
|
|
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
|
|
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
|
|
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
|
|
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
|
|
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
|
|
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
|
|
* SUCH DAMAGE.
|
|
*
|
|
* This file is part of the Contiki operating system.
|
|
*
|
|
*/
|
|
|
|
/**
|
|
* \file
|
|
* The Minimum Rank with Hysteresis Objective Function (MRHOF)
|
|
*
|
|
* This implementation uses the estimated number of
|
|
* transmissions (ETX) as the additive routing metric,
|
|
* and also provides stubs for the energy metric.
|
|
*
|
|
* \author Joakim Eriksson <joakime@sics.se>, Nicolas Tsiftes <nvt@sics.se>
|
|
*/
|
|
|
|
/**
|
|
* \addtogroup uip6
|
|
* @{
|
|
*/
|
|
|
|
#include "net/rpl/rpl-private.h"
|
|
#include "net/nbr-table.h"
|
|
|
|
#define DEBUG DEBUG_NONE
|
|
#include "net/ip/uip-debug.h"
|
|
|
|
static void reset(rpl_dag_t *);
|
|
static void neighbor_link_callback(rpl_parent_t *, int, int);
|
|
static void dao_ack_callback(rpl_parent_t *, int);
|
|
static rpl_parent_t *best_parent(rpl_parent_t *, rpl_parent_t *);
|
|
static rpl_dag_t *best_dag(rpl_dag_t *, rpl_dag_t *);
|
|
static rpl_rank_t calculate_rank(rpl_parent_t *, rpl_rank_t);
|
|
static void update_metric_container(rpl_instance_t *);
|
|
|
|
rpl_of_t rpl_mrhof = {
|
|
reset,
|
|
neighbor_link_callback,
|
|
dao_ack_callback,
|
|
best_parent,
|
|
best_dag,
|
|
calculate_rank,
|
|
update_metric_container,
|
|
1
|
|
};
|
|
|
|
/* Constants for the ETX moving average */
|
|
#define ETX_SCALE 100
|
|
#define ETX_ALPHA 90
|
|
|
|
/* Reject parents that have a higher link metric than the following. */
|
|
#define MAX_LINK_METRIC 10
|
|
|
|
/* Reject parents that have a higher path cost than the following. */
|
|
#define MAX_PATH_COST 100
|
|
|
|
/*
|
|
* The rank must differ more than 1/PARENT_SWITCH_THRESHOLD_DIV in order
|
|
* to switch preferred parent.
|
|
*/
|
|
#define PARENT_SWITCH_THRESHOLD_DIV 2
|
|
|
|
typedef uint16_t rpl_path_metric_t;
|
|
|
|
static rpl_path_metric_t
|
|
calculate_path_metric(rpl_parent_t *p)
|
|
{
|
|
uip_ds6_nbr_t *nbr;
|
|
if(p == NULL) {
|
|
return MAX_PATH_COST * RPL_DAG_MC_ETX_DIVISOR;
|
|
}
|
|
nbr = rpl_get_nbr(p);
|
|
if(nbr == NULL) {
|
|
return MAX_PATH_COST * RPL_DAG_MC_ETX_DIVISOR;
|
|
}
|
|
#if RPL_DAG_MC == RPL_DAG_MC_NONE
|
|
{
|
|
return p->rank + (uint16_t)nbr->link_metric;
|
|
}
|
|
#elif RPL_DAG_MC == RPL_DAG_MC_ETX
|
|
return p->mc.obj.etx + (uint16_t)nbr->link_metric;
|
|
#elif RPL_DAG_MC == RPL_DAG_MC_ENERGY
|
|
return p->mc.obj.energy.energy_est + (uint16_t)nbr->link_metric;
|
|
#else
|
|
#error "Unsupported RPL_DAG_MC configured. See rpl.h."
|
|
#endif /* RPL_DAG_MC */
|
|
}
|
|
|
|
static void
|
|
reset(rpl_dag_t *dag)
|
|
{
|
|
PRINTF("RPL: Reset MRHOF\n");
|
|
}
|
|
|
|
static void
|
|
dao_ack_callback(rpl_parent_t *p, int status)
|
|
{
|
|
/* here we need to handle failed DAO's and other stuff */
|
|
PRINTF("RPL: MRHOF - DAO ACK received with status: %d", status);
|
|
if(status >= RPL_DAO_ACK_UNABLE_TO_ACCEPT) {
|
|
/* punish the ETX as if this was 10 packets lost */
|
|
neighbor_link_callback(p, MAC_TX_OK, 10);
|
|
} else if(status == RPL_DAO_ACK_TIMEOUT) { /* timeout = no ack */
|
|
/* punish the total lack of ACK with a similar punishment */
|
|
neighbor_link_callback(p, MAC_TX_OK, 10);
|
|
}
|
|
}
|
|
|
|
static void
|
|
neighbor_link_callback(rpl_parent_t *p, int status, int numtx)
|
|
{
|
|
uint16_t recorded_etx = 0;
|
|
uint16_t packet_etx = numtx * RPL_DAG_MC_ETX_DIVISOR;
|
|
uint16_t new_etx;
|
|
uip_ds6_nbr_t *nbr = NULL;
|
|
|
|
nbr = rpl_get_nbr(p);
|
|
if(nbr == NULL) {
|
|
/* No neighbor for this parent - something bad has occurred */
|
|
return;
|
|
}
|
|
|
|
recorded_etx = nbr->link_metric;
|
|
|
|
/* Do not penalize the ETX when collisions or transmission errors occur. */
|
|
if(status == MAC_TX_OK || status == MAC_TX_NOACK) {
|
|
if(status == MAC_TX_NOACK) {
|
|
packet_etx = MAX_LINK_METRIC * RPL_DAG_MC_ETX_DIVISOR;
|
|
}
|
|
|
|
if(p->flags & RPL_PARENT_FLAG_LINK_METRIC_VALID) {
|
|
/* We already have a valid link metric, use weighted moving average to update it */
|
|
new_etx = ((uint32_t)recorded_etx * ETX_ALPHA +
|
|
(uint32_t)packet_etx * (ETX_SCALE - ETX_ALPHA)) / ETX_SCALE;
|
|
} else {
|
|
/* We don't have a valid link metric, set it to the current packet's ETX */
|
|
new_etx = packet_etx;
|
|
/* Set link metric as valid */
|
|
p->flags |= RPL_PARENT_FLAG_LINK_METRIC_VALID;
|
|
}
|
|
|
|
PRINTF("RPL: ETX changed from %u to %u (packet ETX = %u)\n",
|
|
(unsigned)(recorded_etx / RPL_DAG_MC_ETX_DIVISOR),
|
|
(unsigned)(new_etx / RPL_DAG_MC_ETX_DIVISOR),
|
|
(unsigned)(packet_etx / RPL_DAG_MC_ETX_DIVISOR));
|
|
/* update the link metric for this nbr */
|
|
nbr->link_metric = new_etx;
|
|
}
|
|
}
|
|
|
|
static rpl_rank_t
|
|
calculate_rank(rpl_parent_t *p, rpl_rank_t base_rank)
|
|
{
|
|
rpl_rank_t new_rank;
|
|
rpl_rank_t rank_increase;
|
|
uip_ds6_nbr_t *nbr;
|
|
|
|
if(p == NULL || (nbr = rpl_get_nbr(p)) == NULL) {
|
|
if(base_rank == 0) {
|
|
return INFINITE_RANK;
|
|
}
|
|
rank_increase = RPL_INIT_LINK_METRIC * RPL_DAG_MC_ETX_DIVISOR;
|
|
} else {
|
|
rank_increase = nbr->link_metric;
|
|
if(base_rank == 0) {
|
|
base_rank = p->rank;
|
|
}
|
|
}
|
|
|
|
if(INFINITE_RANK - base_rank < rank_increase) {
|
|
/* Reached the maximum rank. */
|
|
new_rank = INFINITE_RANK;
|
|
} else {
|
|
/* Calculate the rank based on the new rank information from DIO or
|
|
stored otherwise. */
|
|
new_rank = base_rank + rank_increase;
|
|
}
|
|
|
|
return new_rank;
|
|
}
|
|
|
|
static rpl_dag_t *
|
|
best_dag(rpl_dag_t *d1, rpl_dag_t *d2)
|
|
{
|
|
if(d1->grounded != d2->grounded) {
|
|
return d1->grounded ? d1 : d2;
|
|
}
|
|
|
|
if(d1->preference != d2->preference) {
|
|
return d1->preference > d2->preference ? d1 : d2;
|
|
}
|
|
|
|
return d1->rank < d2->rank ? d1 : d2;
|
|
}
|
|
|
|
static rpl_parent_t *
|
|
best_parent(rpl_parent_t *p1, rpl_parent_t *p2)
|
|
{
|
|
rpl_dag_t *dag;
|
|
rpl_path_metric_t min_diff;
|
|
rpl_path_metric_t p1_metric;
|
|
rpl_path_metric_t p2_metric;
|
|
|
|
dag = p1->dag; /* Both parents are in the same DAG. */
|
|
|
|
min_diff = RPL_DAG_MC_ETX_DIVISOR /
|
|
PARENT_SWITCH_THRESHOLD_DIV;
|
|
|
|
p1_metric = calculate_path_metric(p1);
|
|
p2_metric = calculate_path_metric(p2);
|
|
|
|
/* Maintain stability of the preferred parent in case of similar ranks. */
|
|
if(p1 == dag->preferred_parent || p2 == dag->preferred_parent) {
|
|
if(p1_metric < p2_metric + min_diff &&
|
|
p1_metric > p2_metric - min_diff) {
|
|
PRINTF("RPL: MRHOF hysteresis: %u <= %u <= %u\n",
|
|
p2_metric - min_diff,
|
|
p1_metric,
|
|
p2_metric + min_diff);
|
|
return dag->preferred_parent;
|
|
}
|
|
}
|
|
|
|
return p1_metric < p2_metric ? p1 : p2;
|
|
}
|
|
|
|
#if RPL_DAG_MC == RPL_DAG_MC_NONE
|
|
static void
|
|
update_metric_container(rpl_instance_t *instance)
|
|
{
|
|
instance->mc.type = RPL_DAG_MC;
|
|
}
|
|
#else
|
|
static void
|
|
update_metric_container(rpl_instance_t *instance)
|
|
{
|
|
rpl_path_metric_t path_metric;
|
|
rpl_dag_t *dag;
|
|
#if RPL_DAG_MC == RPL_DAG_MC_ENERGY
|
|
uint8_t type;
|
|
#endif
|
|
|
|
instance->mc.type = RPL_DAG_MC;
|
|
instance->mc.flags = RPL_DAG_MC_FLAG_P;
|
|
instance->mc.aggr = RPL_DAG_MC_AGGR_ADDITIVE;
|
|
instance->mc.prec = 0;
|
|
|
|
dag = instance->current_dag;
|
|
|
|
if (!dag->joined) {
|
|
PRINTF("RPL: Cannot update the metric container when not joined\n");
|
|
return;
|
|
}
|
|
|
|
if(dag->rank == ROOT_RANK(instance)) {
|
|
path_metric = 0;
|
|
} else {
|
|
path_metric = calculate_path_metric(dag->preferred_parent);
|
|
}
|
|
|
|
#if RPL_DAG_MC == RPL_DAG_MC_ETX
|
|
instance->mc.length = sizeof(instance->mc.obj.etx);
|
|
instance->mc.obj.etx = path_metric;
|
|
|
|
PRINTF("RPL: My path ETX to the root is %u.%u\n",
|
|
instance->mc.obj.etx / RPL_DAG_MC_ETX_DIVISOR,
|
|
(instance->mc.obj.etx % RPL_DAG_MC_ETX_DIVISOR * 100) /
|
|
RPL_DAG_MC_ETX_DIVISOR);
|
|
#elif RPL_DAG_MC == RPL_DAG_MC_ENERGY
|
|
instance->mc.length = sizeof(instance->mc.obj.energy);
|
|
|
|
if(dag->rank == ROOT_RANK(instance)) {
|
|
type = RPL_DAG_MC_ENERGY_TYPE_MAINS;
|
|
} else {
|
|
type = RPL_DAG_MC_ENERGY_TYPE_BATTERY;
|
|
}
|
|
|
|
instance->mc.obj.energy.flags = type << RPL_DAG_MC_ENERGY_TYPE;
|
|
instance->mc.obj.energy.energy_est = path_metric;
|
|
#endif /* RPL_DAG_MC == RPL_DAG_MC_ETX */
|
|
}
|
|
#endif /* RPL_DAG_MC == RPL_DAG_MC_NONE */
|
|
|
|
/** @}*/
|