-/* tab:4
+/*
* "Copyright (c) 2000-2003 The Regents of the University of California.
* All rights reserved.
*
#include "MultiHopLqi.h"
+#include "CollectionDebugMsg.h"
module LqiRoutingEngineP {
interface LqiRouteStats;
interface CC2420Packet;
interface Leds;
+ interface CollectionDebug;
}
}
uint8_t gLastHeard;
int16_t gCurrentSeqNo;
-
+ int16_t gOriginSeqNo;
+
uint16_t gUpdateInterval;
uint8_t gRecentIndex;
}
lqi_header_t* getHeader(message_t* msg) {
- return (lqi_header_t*)call Packet.getPayload(msg, NULL);
+ return (lqi_header_t*)call Packet.getPayload(msg, sizeof(lqi_header_t));
}
lqi_beacon_msg_t* getBeacon(message_t* msg) {
- return (lqi_beacon_msg_t*)call Packet.getPayload(msg, NULL);
+ return (lqi_beacon_msg_t*)call Packet.getPayload(msg, sizeof(lqi_beacon_msg_t));
}
task void SendRouteTask() {
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) {
bMsg->cost = 0;
bMsg->originaddr = TOS_NODE_ID;
bMsg->hopcount = 0;
- bMsg->originseqno = gCurrentSeqNo;
bMsg->seqno = gCurrentSeqNo++;
}
else {
bMsg->cost = gbCurrentParentCost + gbCurrentLinkEst;
bMsg->originaddr = TOS_NODE_ID;
bMsg->hopcount = gbCurrentHopCount;
- bMsg->originseqno = gCurrentSeqNo;
bMsg->seqno = gCurrentSeqNo++;
}
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);
}
}
gbCurrentHopCount = ROUTE_INVALID;
gbCurrentCost = 0xfffe;
+ gOriginSeqNo = 0;
gCurrentSeqNo = 0;
gUpdateInterval = BEACON_PERIOD;
msgBufBusy = FALSE;
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;
}
command error_t RouteSelect.initializeFields(message_t* msg) {
- lqi_header_t* header = (lqi_header_t*)call Packet.getPayload(msg, NULL);
+ lqi_header_t* header = getHeader(msg);
header->originaddr = TOS_NODE_ID;
- header->originseqno = gCurrentSeqNo;
-
+ header->originseqno = gOriginSeqNo++;
+ 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.startOneShot((uint32_t)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;
}
event void AMSend.sendDone(message_t* msg, error_t success) {
msgBufBusy = FALSE;
}
+
+ /* Default implementations for CollectionDebug calls.
+ * These allow CollectionDebug not to be wired to anything if debugging
+ * is not desired. */
+
+ default command error_t CollectionDebug.logEvent(uint8_t type) {
+ return SUCCESS;
+ }
+ default command error_t CollectionDebug.logEventSimple(uint8_t type, uint16_t arg) {
+ return SUCCESS;
+ }
+ default command error_t CollectionDebug.logEventDbg(uint8_t type, uint16_t arg1, uint16_t arg2, uint16_t arg3) {
+ return SUCCESS;
+ }
+ default command error_t CollectionDebug.logEventMsg(uint8_t type, uint16_t msg, am_addr_t origin, am_addr_t node) {
+ return SUCCESS;
+ }
+ default command error_t CollectionDebug.logEventRoute(uint8_t type, am_addr_t parent, uint8_t hopcount, uint16_t etx) {
+ return SUCCESS;
+ }
}
-
+