#include "MultiHopLqi.h"
+#include "CollectionDebugMsg.h"
module LqiRoutingEngineP {
interface LqiRouteStats;
interface CC2420Packet;
interface Leds;
+ interface CollectionDebug;
}
}
dbg("LQI","MultiHopRSSI Sending route update msg.\n");
if (gbCurrentParent != TOS_BCAST_ADDR) {
- dbg("LQO","MultiHopRSSI: Parent = %d\n", gbCurrentParent);
+ dbg("LQI","MultiHopRSSI: Parent = %d\n", gbCurrentParent);
}
if (msgBufBusy) {
if (call AMSend.send(TOS_BCAST_ADDR, &msgBuf, length) == SUCCESS) {
msgBufBusy = TRUE;
+ call CollectionDebug.logEventRoute(NET_C_TREE_SENT_BEACON, bMsg->parent, 0, bMsg->cost);
}
}
command error_t RootControl.setRoot() {
call Leds.led2On();
+ call CollectionDebug.logEventRoute(NET_C_TREE_NEW_PARENT, TOS_NODE_ID, 0, 0);
isRoot = TRUE;
return SUCCESS;
}
if (isRoot) {
return FAIL;
}
-
+
if (hdr->originaddr != TOS_NODE_ID && resend == 0) {
// supress duplicate packets
for (i = 0; i < MHOP_HISTORY_SIZE; i++) {
if ((gRecentPacketSender[i] == call AMPacket.source(msg)) &&
(gRecentPacketSeqNo[i] == hdr->seqno)) {
+ call CollectionDebug.logEvent(NET_C_FE_DUPLICATE_CACHE_AT_SEND);
+ dbg("LQI", "%s no route as this is a duplicate!\n", __FUNCTION__);
return FAIL;
}
}
gbCurrentLinkEst = 0x7fff;
gbCurrentParent = TOS_BCAST_ADDR;
gbCurrentHopCount = ROUTE_INVALID;
+ dbg("LQI", "%s no route as we are in a cycle!\n", __FUNCTION__);
return FAIL;
}
}
gRecentOriginPacketSeqNo[gRecentOriginIndex] = hdr->originseqno;
gRecentOriginIndex = (gRecentOriginIndex + 1) % MHOP_HISTORY_SIZE;
}
-
+
if (resend == 0) {
hdr->seqno = gCurrentSeqNo++;
}
+ dbg("LQI", "LQI setting destination to %hu and link quality ?\n", gbCurrentParent);
call AMPacket.setDestination(msg, gbCurrentParent);
return SUCCESS;
header->originaddr = TOS_NODE_ID;
header->originseqno = gCurrentSeqNo;
-
+ header->seqno = gCurrentSeqNo;
+
if (isRoot) {
header->hopcount = 0;
}
header->hopcount = gbCurrentHopCount;
}
+ dbg("LQI", "LQI setting hopcount to %hhu\n", gbCurrentHopCount);
return SUCCESS;
}
event void Timer.fired() {
+ call Leds.led0Toggle();
post TimerTask();
- call Timer.startOneShot(1024 * gUpdateInterval + 1);
+ call Timer.startPeriodic(1024 * gUpdateInterval + 1);
}
event message_t* Receive.receive(message_t* msg, void* payload, uint8_t len) {
+ lqi_beacon_msg_t* bMsg = (lqi_beacon_msg_t*)payload;
+ am_addr_t source = call AMPacket.source(msg);
+ uint8_t lqi = call CC2420Packet.getLqi(msg);
+
+ call CollectionDebug.logEventRoute(NET_C_TREE_RCV_BEACON, source, 0, bMsg->cost);
+
if (isRoot) {
return msg;
}
else {
- lqi_beacon_msg_t* bMsg = (lqi_beacon_msg_t*)payload;
- am_addr_t source = call AMPacket.source(msg);
- uint8_t lqi = call CC2420Packet.getLqi(msg);
-
+ dbg("LQI,LQIRoute", "LQI receiving routing beacon from %hu with LQI %hhu that advertises %hu.\n", source, lqi, bMsg->cost);
if (source == gbCurrentParent) {
// try to prevent cycles
if (bMsg->parent != TOS_NODE_ID) {
gbCurrentParentCost = bMsg->cost;
gbCurrentLinkEst = adjustLQI(lqi);
gbCurrentHopCount = bMsg->hopcount + 1;
+ dbg("LQI,LQIRoute", " -- Not a loop\n");
}
else {
gLastHeard = 0;
gbCurrentLinkEst = 0x7fff;
gbCurrentParent = TOS_BCAST_ADDR;
gbCurrentHopCount = ROUTE_INVALID;
+ dbg("LQI,LQIRoute", " -- Detected a loop\n");
}
} else {
gbCurrentParentCost = bMsg->cost;
gbCurrentLinkEst = adjustLQI(lqi);
gbCurrentHopCount = bMsg->hopcount + 1;
+ call CollectionDebug.logEventRoute(NET_C_TREE_NEW_PARENT, gbCurrentParent, 0, gbCurrentParentCost + gbCurrentLinkEst);
+ dbg("LQI,LQIRoute", " -- Not a cycle.\n");
+ }
+ else {
+ dbg("LQI,LQIRoute", " -- CYCLE.\n");
}
}
}
+ dbg("LQI,LQIRoute", "Set my count to %hhu, my link to %hu and my cost to %hu.\n", gbCurrentHopCount, gbCurrentLinkEst, gbCurrentParentCost);
return msg;
}
}
}
-
+