#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;
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;
}
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;
}
lqi_header_t* header = (lqi_header_t*)call Packet.getPayload(msg, NULL);
header->originaddr = TOS_NODE_ID;
- header->originseqno = gCurrentSeqNo;
+ header->originseqno = gOriginSeqNo++;
header->seqno = gCurrentSeqNo;
if (isRoot) {
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
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 {
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;
+ }
}