public static void SerialCallback_base_node(byte[] readBytes) { if (readBytes.Length < 1) { return; } var readChars = System.Text.Encoding.UTF8.GetChars(readBytes); // Decode the input bytes as char using UTF8 string tempStr = new string(readChars); //Debug.Print("Base serial input: " + tempStr); // If 1, note that PC wants to get switch data if (tempStr.Length == 8 && tempStr.Substring(0, 7).Equals("fffffff")) { int rcvSize = AppGlobal.RecieveMessageSize; var rcvPayloadBytes = new byte[rcvSize]; ushort originator = AppGlobal.AppPipe.MACRadioObj.RadioAddress; AppGlobal.ClassificationType classificationType = AppGlobal.ClassificationType.Recieve; byte TTL = Byte.MaxValue; var headerSize = AppGlobal.MoteMessages.Compose.RecievePacket(rcvPayloadBytes, originator, _destination, classificationType, _packetNumber, _TTL, (ushort)_payloadLength); // add payload AppGlobal.MoteMessages.AddPayload.RecievePacket(rcvPayloadBytes, headerSize, readBytes, _payloadLength); #if DBG_VERBOSE Debug.Print("Sending Packet #" + _packetNumber + " to neighbor " + _destination); Debug.Print(" Classification: " + (char)classificationType); Debug.Print(" Originator: " + originator); Debug.Print(" path Length: " + _pathLength); Debug.Print(" payload Length: " + _payloadLength + "\n"); #endif try { #if DBG_VERBOSE Debug.Print("Send Successful"); #endif var status = RoutingGlobal.SendToChild(AppGlobal.AppPipe, _destination, rcvPayloadBytes, rcvSize); } catch (Exception ex) { Debug.Print("SerialComm exception for Detection message [" + rcvSize + "]\n" + ex); } //Debug.Print("I know something you don't+ debug print from mote "); //temComm.Write("helloToYouToo: from Mote \r\n"); //string tempNewStr = "fffffff" + newReturnNum; //temComm.Write(tempNewStr); //_tempTimer = new Timer(temp_timer, null, 0, 1 * 10000); //send readBytes to orignator who send them return; } }
public static void Send_ResetWave() { // If in a reset wave already, return. if (RoutingGlobal._color == Color.Red) { return; } // Refresh children table _children.CleanseChildrenTable(); if (!_children.IsEmpty()) { RoutingGlobal._color = Color.Red; var msgBytes = new byte[3]; var size = ComposeMessages.CreateResetMessage(msgBytes, (ushort)_resetMsgNum); MulticastToChildren(msgBytes, size); _distResetTimer.Change(120000, Timeout.Infinite); // 2 min timer. TODO: Make timeout interval contingent on distance from the reset wave origin } else { // Create status query to existing candidates var msgBytes = new byte[3]; var size = ComposeMessages.CreateStatusQueryMessage(msgBytes, (ushort)_statusMsgNum); // Multicast query to candidates if (MulticastToCandidates(msgBytes, size)) // If there are candidates { // Wait for response _statusResponseTimer.Change(10000, Timeout.Infinite); // 10 second timer // Reset candidate table ushort[] neighbors = MACBase.NeighborListArray(); CandidateTable.Initialize((byte)neighbors.Length); } else //Empty candidate table; set parent immediately { // Set best node in candidate table as parent RoutingGlobal.SetParent(false); // Reset params RoutingGlobal._color = Color.Green; // Send "Add Parent" message to new parent DistributedReset.Send_AddParent(); _statusMsgNum++; _resetMsgNum++; } } }
public static ushort SendToChild(MACPipe mac, ushort destination, byte[] msgBytes, int length) { ushort next_neighbor = RoutingGlobal.GetChild(destination); // If in a reset, do not forward if (RoutingGlobal._color == Color.Red) { #if DBG_VERBOSE Debug.Print("\tIn a Reset wave... not forwarded"); #endif return(999); } ushort index = mac.EnqueueToSend(next_neighbor, msgBytes, 0, (ushort)length); return(mac.IsMsgIDValid(index) ? index : (ushort)999); }
private static void Status_Response(object state) { #if DBG_VERBOSE Debug.Print("*** STATUS TIMEOUT FIRED: query# " + _statusMsgNum + "; setting new parent ***"); #elif DBG_SIMPLE Debug.Print("Setting new parent after status query#" + _statusMsgNum); #endif // Try to switch to a new parent // Check if candidate table has valid entries RoutingGlobal.CleanseCandidateTable(_distResetPipe); // Set best node in candidate table as parent RoutingGlobal.SetParent(false); // Reset params RoutingGlobal._color = Color.Green; // Send "Add Parent" message to new parent DistributedReset.Send_AddParent(); _statusMsgNum++; }
private static void Reset_State(object state) { #if DBG_VERBOSE Debug.Print("*** RESET WAVE TIMEOUT FIRED: Initiating completion wave# " + _resetMsgNum + " ***"); #elif DBG_SIMPLE Debug.Print("Initiating completion wave " + _resetMsgNum + ""); #endif Send_CompletionWave(_resetMsgNum); // Purge children table _children = new ChildrenList(); _completionMsgs = null; // Create status query to existing candidates var msgBytes = new byte[3]; var size = ComposeMessages.CreateStatusQueryMessage(msgBytes, (ushort)_statusMsgNum); // Multicast query to candidates if (MulticastToCandidates(msgBytes, size)) // If there are candidates { // Wait for response _statusResponseTimer.Change(10000, Timeout.Infinite); // 10 second timer // Reset candidate table ushort[] neighbors = MACBase.NeighborListArray(); CandidateTable.Initialize((byte)neighbors.Length); } else //Empty candidate table; set parent immediately { // Set best node in candidate table as parent RoutingGlobal.SetParent(false); // Reset params RoutingGlobal._color = Color.Green; // Send "Add Parent" message to new parent DistributedReset.Send_AddParent(); _statusMsgNum++; } _resetMsgNum++; // No more completion messages to be accepted beyond this point }
internal static int CreateStatusResponseMessage(byte[] msgBytes, ushort beaconNum) { var idx = 0; msgBytes[idx] = (byte)MessageIds.StatusResponse; idx += sizeof(byte); msgBytes[idx] = (byte)RoutingGlobal._color; idx += sizeof(byte); msgBytes[idx] = RoutingGlobal.BestEtx; idx += sizeof(byte); var beaconAdj = (ushort)Math.Min(beaconNum, ushort.MaxValue); BitConverter.InsertValueIntoArray(msgBytes, idx, beaconAdj); idx += sizeof(ushort); msgBytes[idx] = RoutingGlobal.GetPathEWRNP(); idx = +sizeof(byte); return(idx); }
public static Candidate GetBestCandidateRelativeToParent(bool refresh) { // Initializing parent as current best candidate Candidate tmpBest = new Candidate(RoutingGlobal.Parent, RoutingGlobal._parentLinkRSSI, RoutingGlobal.BestEtx, byte.MaxValue, RoutingGlobal.GetPathEWRNP()); if (!IsEmpty()) { //bool candidateFound = false; for (int i = 0; i < _length; i++) { if (refresh) { _candidateList[i].SetPathEWRNP(); } if (_candidateList[i].GetPathEWRNP() < tmpBest.GetPathEWRNP() || (_candidateList[i].GetPathEWRNP() == tmpBest.GetPathEWRNP() && _candidateList[i].GetEtx() < tmpBest.GetEtx()) || (_candidateList[i].GetPathEWRNP() == tmpBest.GetPathEWRNP() && _candidateList[i].GetEtx() == tmpBest.GetEtx() && _candidateList[i].GetRSSI() > tmpBest.GetRSSI())) { tmpBest = _candidateList[i]; } #region no longer using _minRSSI // if (_candidateList[i].GetRSSI() >= RoutingGlobal._minRSSI) // { // if (_candidateList[i].GetPathEWRNP() < tmpBest.GetPathEWRNP() || (_candidateList[i].GetPathEWRNP() == tmpBest.GetPathEWRNP() && _candidateList[i].GetEtx() < tmpBest.GetEtx()) || (_candidateList[i].GetPathEWRNP() == tmpBest.GetPathEWRNP() && _candidateList[i].GetEtx() == tmpBest.GetEtx() && _candidateList[i].GetRSSI() > tmpBest.GetRSSI())) // { // tmpBest = _candidateList[i]; // candidateFound = true; //#if DBG_SIMPLE // Debug.Print("candidate found: " + tmpBest.GetMacID().ToString() + " RSSI: " + tmpBest.GetRSSI().ToString()); //#endif // } // } #endregion } } return(tmpBest); }
private static void DistResetStreamReceive(IMAC macBase, DateTime time, Packet packet) { #if DBG_VERBOSE DebuggingSupport.PrintMessageReceived(macBase, "Distributed Reset"); #endif if (packet == null) { return; } #if !DBG_LOGIC Debug.Print("\tRSSI: " + packet.RSSI + ", from " + packet.Src); #endif var rcvPayloadBytes = packet.Payload; //var payload = new string(Encoding.UTF8.GetChars(rcvPayloadBytes)); #if DBG_VERBOSE SystemGlobal.PrintNumericVals("\tDistributed reset Rcv: ", rcvPayloadBytes); #endif try { ushort[] neighbors = MACBase.NeighborListArray(); var neighborStatus = _distResetPipe.NeighborStatus(packet.Src); if (neighborStatus == null) { #if DBG_VERBOSE Debug.Print("\t\t!!!!!!!!!!!!!!!!! Node " + packet.Src + " is not a Neighbor (MACBase.NeighborStatus returned null)"); #elif DBG_SIMPLE Debug.Print("Sender not a neighbor."); #endif // If node in children table, drop it if (Array.IndexOf(_children._childrenList, packet.Src) < -1) { _children.DropChild(packet.Src); } return; } //Debug.Print("\t\tFwd avg RSSI: " + neighborStatus.ReceiveLink.AverageRSSI + ", Rev avg RSSI: " + neighborStatus.SendLink.AverageRSSI); switch ((MessageIds)rcvPayloadBytes[0]) { case MessageIds.AddParent: #if !DBG_LOGIC Debug.Print("\t>>> AddParent"); #endif if (_children.AddChild(packet.Src)) { #if DBG_VERBOSE Debug.Print("+++ Added new child: " + packet.Src + " +++"); #elif DBG_SIMPLE Debug.Print("Added new child: " + packet.Src); #endif } else { #if DBG_VERBOSE Debug.Print("@@@ Child already exists: " + packet.Src + " @@@"); #endif } return; case MessageIds.DropParent: #if !DBG_LOGIC Debug.Print("\t>>> DropParent"); #endif if (_children.DropChild(packet.Src)) { #if DBG_VERBOSE Debug.Print("--- Dropped child: " + packet.Src + " ---"); #elif DBG_SIMPLE Debug.Print("Dropped child: " + packet.Src); #endif } else { #if DBG_VERBOSE Debug.Print("@@@ Child does not exist: " + packet.Src + " @@@"); #endif } return; case MessageIds.Reset: #if !DBG_LOGIC Debug.Print("\t>>> ResetWave"); #endif // Decode round number ushort round_num; ParseMessages.ParseResetMessage(rcvPayloadBytes, out round_num); // Is this a legit reset wave? if (RoutingGlobal._color == Color.Red || packet.Src != RoutingGlobal.Parent || round_num != _resetMsgNum) { #if DBG_VERBOSE Debug.Print("!!! ILLEGAL RESET WAVE# " + round_num + ": Received from: " + packet.Src + " !!!"); #elif DBG_SIMPLE Debug.Print("Illegal reset wave " + round_num + " from " + packet.Src); #endif return; } // Refresh children table _children.CleanseChildrenTable(); if (_children.IsEmpty()) // Start completion wave if leaf node { #if DBG_VERBOSE Debug.Print("*** LEAF NODE REACHED: Initiating completion wave# " + round_num + " ***"); #elif DBG_SIMPLE Debug.Print("At leaf; initiating completion wave " + round_num); #endif Send_CompletionWave(round_num); // Create status query to existing candidates var msgBytes = new byte[3]; var size = ComposeMessages.CreateStatusQueryMessage(msgBytes, (ushort)_statusMsgNum); // Multicast query to candidates if (MulticastToCandidates(msgBytes, size)) // If there are candidates { // Wait for response _statusResponseTimer.Change(10000, Timeout.Infinite); // 10 second timer // Reset candidate table CandidateTable.Initialize((byte)neighbors.Length); } else //Empty candidate table; set parent immediately { // Set best node in candidate table as parent RoutingGlobal.SetParent(false); // Reset params RoutingGlobal._color = Color.Green; // Send "Add Parent" message to new parent DistributedReset.Send_AddParent(); _statusMsgNum++; } _resetMsgNum++; } else { // Forward reset wave to own children Send_ResetWave(rcvPayloadBytes); } return; case MessageIds.Completion: #if !DBG_LOGIC Debug.Print("\t>>> CompletionWave"); #endif // Decode round number ushort round; ParseMessages.ParseCompletionMessage(rcvPayloadBytes, out round); // Is this a legit completion wave? int pos = Array.IndexOf(_children._childrenList, packet.Src); if (RoutingGlobal._color != Color.Red || pos == -1 || round != _resetMsgNum) { #if DBG_VERBOSE Debug.Print("!!! ILLEGAL COMPLETION WAVE# " + round + ": Received from: " + packet.Src + " !!!"); #elif DBG_SIMPLE Debug.Print("Illegal completion wave " + round + " from " + packet.Src); #endif return; } _completionMsgs[pos] = true; // Forward completion wave if received from all children for (int i = 0; i < _completionMsgs.Length; i++) { if (!_completionMsgs[i]) // If not received from any child, return { return; } } // Else, forward completion wave to parent #if DBG_VERBOSE Debug.Print("*** RECEIVED COMPLETION MESSAGES FROM ALL CHILDREN: initiating completion wave# " + round + " ***"); #elif DBG_SIMPLE Debug.Print("All children responded; initiating completion wave " + round); #endif Send_CompletionWave(round); // Purge children table _children = new ChildrenList(); _completionMsgs = null; _distResetTimer.Change(Timeout.Infinite, Timeout.Infinite); // Create status query to existing candidates var msgBytes1 = new byte[3]; var size1 = ComposeMessages.CreateStatusQueryMessage(msgBytes1, (ushort)_statusMsgNum); // Multicast query to candidates if (MulticastToCandidates(msgBytes1, size1)) // If there are candidates { // Wait for response _statusResponseTimer.Change(10000, Timeout.Infinite); // 10 second timer // Reset candidate table CandidateTable.Initialize((byte)neighbors.Length); } else //Empty candidate table; set parent immediately { // Set best node in candidate table as parent RoutingGlobal.SetParent(false); // Reset params RoutingGlobal._color = Color.Green; // Send "Add Parent" message to new parent DistributedReset.Send_AddParent(); _statusMsgNum++; } _resetMsgNum++; return; case MessageIds.StatusQuery: #if !DBG_LOGIC Debug.Print("\t>>> StatusQuery"); #endif //If in a reset wave or no valid path, don't bother responding if (RoutingGlobal._color == Color.Red || RoutingGlobal.BestEtx >= RoutingGlobal.Infinity) { #if DBG_VERBOSE Debug.Print("!!! Not responding. Color: " + RoutingGlobal._color + ", BestEtx: " + RoutingGlobal.BestEtx + " !!!"); #elif DBG_SIMPLE Debug.Print("Not responding. Color: " + RoutingGlobal._color + ", BestEtx: " + RoutingGlobal.BestEtx); #endif return; } // Decode round number ushort status_msgnum; ParseMessages.ParseStatusQueryMessage(rcvPayloadBytes, out status_msgnum); // Send status response var msgBytes2 = new byte[5]; var size2 = ComposeMessages.CreateStatusResponseMessage(msgBytes2, status_msgnum); NetOpStatus status = _distResetPipe.Send(RoutingGlobal.Parent, msgBytes2, 0, (ushort)size2); return; case MessageIds.StatusResponse: #if !DBG_LOGIC Debug.Print("\t>>> StatusResponse"); #endif ushort status_respnum; Color col; byte etx; byte pathEWRNP_B2N; // Decode message ParseMessages.ParseStatusResponseMessage(rcvPayloadBytes, out col, out etx, out status_respnum, out pathEWRNP_B2N); // Is this a valid response? if (status_respnum != _statusMsgNum) { #if DBG_VERBOSE Debug.Print("!!! ILLEGAL STATUS RESPONSE# " + status_respnum + ": Received from: " + packet.Src + " !!!"); #elif DBG_SIMPLE Debug.Print("Illegal status response " + status_respnum + " from " + packet.Src); #endif return; } byte tempEtx = (byte)(etx + 1); // Add candidate if its offered etx exceeds _minEtx if (tempEtx >= RoutingGlobal._minEtx) { CandidateTable.AddCandidate(packet.Src, 0, tempEtx, pathEWRNP_B2N, RoutingGlobal.MaxEtx); // TODO: Add RSSI later #if DBG_VERBOSE Debug.Print("+++ Added new candidate: " + packet.Src + "; path length: " + tempEtx + " +++"); #elif DBG_SIMPLE Debug.Print("New candidate " + packet.Src + ":[" + tempEtx + "]"); #endif } else { #if DBG_VERBOSE Debug.Print("--- Not a candidate: " + packet.Src + "; path length: " + tempEtx + " ---"); #elif DBG_SIMPLE Debug.Print("Not a candidate " + packet.Src + ":[" + tempEtx + "]"); #endif } return; default: #if !DBG_LOGIC Debug.Print("\tUnknown message received <" + rcvPayloadBytes[0] + ">"); #endif break; } } catch (Exception e) { Debug.Print(e.StackTrace); } }
public static void SerialCallback_client_node(byte[] readBytes) { if (readBytes.Length < 1) { return; } var readChars = System.Text.Encoding.UTF8.GetChars(readBytes); // Decode the input bytes as char using UTF8 string tempStr = new string(readChars); //Debug.Print("Client serial input: " + tempStr); // If 1, note that PC wants to get switch data if (readBytes.Length == 8 && tempStr.Substring(0, 7).Equals("fffffff")) { // byte payloadValue = (byte)_rand.Next(11); // Change both for different payload sizes // byte payloadValue = (byte)_rand.Next(11); // Change both for different payload sizes int payloadLength = readBytes.Length; int sendSize = AppGlobal.SendMessageSize; var routedMsg = new byte[sendSize]; ushort originator = AppGlobal.AppPipe.MACRadioObj.RadioAddress; AppGlobal.ClassificationType classificationType = AppGlobal.ClassificationType.Send; byte TTL = Byte.MaxValue; var headerSize = AppGlobal.MoteMessages.Compose.SendPacket(routedMsg, originator, classificationType, _sendMsgNum, TTL, (ushort)payloadLength); // add payload AppGlobal.MoteMessages.AddPayload.SendPacket(routedMsg, headerSize, readBytes, payloadLength); if (RoutingGlobal.IsParent) { #if DBG_VERBOSE Debug.Print("Sending Packet #" + _sendMsgNum + " to Parent"); Debug.Print(" Classification: " + (char)classificationType); Debug.Print(" Originator: " + originator); Debug.Print(" payload Length: " + payloadLength + "\n"); #endif var status = RoutingGlobal.SendToParent(AppGlobal.AppPipe, routedMsg, sendSize); if (status != 999) { Debug.Print("Send Successful"); _sendMsgNum++; RoutingGlobal.UpdateNumTriesInCurrentWindow_Parent(1); #if !DBG_LOGIC Debug.Print("Updated numTriesInCurrentWindow for Parent " + RoutingGlobal.Parent + "; new value = " + RoutingGlobal.GetNumTriesInCurrentWindow_Parent()); #endif } else //Retry once { #if !DBG_LOGIC Debug.Print("Retrying packet"); #endif RoutingGlobal.CleanseCandidateTable(AppGlobal.AppPipe); Candidate tmpBest = CandidateTable.GetBestCandidate(false); AppGlobal.TempParent = tmpBest.GetMacID(); status = AppGlobal.SendToTempParent(AppGlobal.AppPipe, routedMsg, sendSize); if (status != 999) { Debug.Print("Send Successful"); _sendMsgNum++; tmpBest.UpdateNumTriesInCurrentWindow(1); #if !DBG_LOGIC Debug.Print("Updated numTriesInCurrentWindow for TempParent " + AppGlobal.TempParent + "; new value = " + tmpBest.GetNumTriesInCurrentWindow()); #endif } } } //Debug.Print("I know something you don't+ debug print from mote "); //temComm.Write("helloToYouToo: from Mote \r\n"); //Random random = new Random(); //int newReturnNum = random.Next(9); //String tempNewStr = "fffffff" + newReturnNum; //temComm.Write(tempNewStr); //_tempTimer = new Timer(temp_timer, null, 0, 1 * 10000); //send readBytes to parent. return; } }
/// <summary> /// Handle an App message /// </summary> /// <param name="macBase"></param> /// <param name="dateTime"></param> /// <param name="packet"></param> public static void AppPipeReceive(IMAC macBase, DateTime dateTime, Packet packet) { #if DBG_VERBOSE DebuggingSupport.PrintMessageReceived(macBase, "App"); #elif DBG_SIMPLE Debug.Print(""); Debug.Print("AppPipeReceive "); #endif try { #if !DBG_LOGIC Debug.Print("\tFrom " + packet.Src); #endif DebuggingSupport.PrintMessageReceived(macBase, "App"); //Debug.Print("\ton " + packet.PayloadType); //var rcvPayloadBytes = packet.Payload; //var rcvPayloadBytes = SystemGlobal.GetTrimmedPayload(packet); byte[] rcvPayloadBytes = packet.Payload; #if DBG_VERBOSE SystemGlobal.PrintNumericVals("App Rcv: ", rcvPayloadBytes); #elif DBG_SIMPLE Debug.Print(""); #endif switch ((AppGlobal.MessageIds)rcvPayloadBytes[0]) { case AppGlobal.MessageIds.Detect: { AppGlobal.ClassificationType classificationType; ushort originator; byte TTL; ushort detectionNumber; AppGlobal.MoteMessages.Parse.Detection(rcvPayloadBytes, out classificationType, out detectionNumber, out originator, out TTL); #if DBG_SIMPLE Debug.Print("\tDetect. From neighbor " + packet.Src + " # " + detectionNumber + ". Classification " + (char)classificationType + " created by " + originator + " with TTL " + TTL); #endif #if RELAY_NODE || CLIENT_NODE // Check if originated by self or if TTL-1 = 0 if (originator == AppGlobal.AppPipe.MACRadioObj.RadioAddress || --TTL == 0) { return; } #region Uncomment when scheduler disabled // If in a reset, do not forward TODO: Change this to "spray" if (RoutingGlobal._color == Color.Red) { #if DBG_VERBOSE Debug.Print("\tIn a Reset wave... not forwarded"); #endif return; } #endregion #region Uncomment when scheduler disabled /* TODO: Uncomment lines 368-394 when not using scheduler*/ // Not originated by self. // If parent is available, pass it on if (RoutingGlobal.IsParent) { byte[] routedMsg = new byte[rcvPayloadBytes.Length]; var size = AppGlobal.MoteMessages.Compose.Detection(routedMsg, originator, classificationType, detectionNumber, TTL); Debug.Print("routed message len: " + routedMsg.Length); Debug.Print("routedMsg: " + routedMsg.ToString()); var status = RoutingGlobal.SendToParent(AppGlobal.AppPipe, routedMsg, size); Debug.Print("status " + status); if (status != 999) { RoutingGlobal.UpdateNumTriesInCurrentWindow_Parent(1); #if !DBG_LOGIC Debug.Print("Updated numTriesInCurrentWindow for Parent " + RoutingGlobal.Parent + "; new value = " + RoutingGlobal.GetNumTriesInCurrentWindow_Parent()); #endif } else //Retry once { #if !DBG_LOGIC Debug.Print("Retrying packet"); #endif if (status != 999) { RoutingGlobal.UpdateNumTriesInCurrentWindow_Parent(1); } } } #endregion #elif BASE_STATION var msg = AppGlobal.PCMessages.Compose.Detection(originator, classificationType, detectionNumber); try { _serialComm.Write(msg); #if DBG_VERBOSE Debug.Print("\n************ Detection sent to PC " + msg.Substring(1, msg.Length - 2)); #endif } catch (Exception ex) { Debug.Print("SerialComm exception for Detection message [" + msg + "]\n" + ex); } #endif break; } case AppGlobal.MessageIds.Send: { AppGlobal.ClassificationType classificationType; ushort originator; byte TTL; ushort sndNumber; ushort payloadLength; _lcd.Write("PSnd"); AppGlobal.MoteMessages.Parse.SendPacket(rcvPayloadBytes, out classificationType, out sndNumber, out originator, out TTL, out payloadLength); int rcvHeader = AppGlobal.SendMessageSize; byte[] sendPayload = new byte[payloadLength]; AppGlobal.MoteMessages.getPayload.SendPacket(rcvPayloadBytes, rcvHeader, sendPayload, (int)payloadLength); #if DBG_VERBOSE Debug.Print("Received Packet #" + sndNumber + " from neighbor " + packet.Src); Debug.Print(" Classification: " + (char)classificationType); Debug.Print(" Originator: " + originator); Debug.Print(" payload Length: " + payloadLength + "\n"); //Debug.Print("Received Packet # " + sndNumber + "From neighbor " + packet.Src + " with Classification " + (char)classificationType + ", created by " + originator + " with payload " + payloadString); #endif #if CLIENT_NODE Debug.Print("\tClient Recieved a send message..."); //_serialComm.Write(rcvPayloadBytes); #elif RELAY_NODE // Check if originated by self or if TTL-1 = 0 if (originator == AppGlobal.AppPipe.MACRadioObj.RadioAddress || --TTL == 0) { return; } #region Uncomment when scheduler disabled // If in a reset, do not forward TODO: Change this to "spray" if (RoutingGlobal._color == Color.Red) { #if DBG_VERBOSE Debug.Print("\tIn a Reset wave... not forwarded"); #endif return; } #endregion #region Uncomment when scheduler disabled /* TODO: Uncomment lines 368-394 when not using scheduler*/ // Not originated by self. // If parent is available, pass it on int payloadSize = sizeof(byte) * payloadLength; // remove ushort in length because popping first in path int rcvSize = rcvHeader + payloadSize; byte[] routedMsg = new byte[rcvSize]; if (RoutingGlobal.IsParent) { var headerSize = AppGlobal.MoteMessages.Compose.SendPacket(routedMsg, originator, classificationType, sndNumber, TTL, payloadLength); AppGlobal.MoteMessages.AddPayload.RecievePacket(routedMsg, headerSize, sendPayload, payloadLength); Debug.Print("Sending Packet # " + sndNumber + " to neighbor " + RoutingGlobal.Parent); Debug.Print(" Classification: " + (char)classificationType); Debug.Print(" Originator: " + originator); Debug.Print(" payload Length: " + payloadLength + "\n"); var status = RoutingGlobal.SendToParent(AppGlobal.AppPipe, routedMsg, rcvSize); //Neighbor(AppGlobal.AppPipe, next_neighbor, routedMsg, size); if (status != 999) { Debug.Print("Send Successful"); RoutingGlobal.UpdateNumTriesInCurrentWindow_Parent(1); #if !DBG_LOGIC Debug.Print("Updated numTriesInCurrentWindow for Parent " + RoutingGlobal.Parent + "; new value = " + RoutingGlobal.GetNumTriesInCurrentWindow_Parent()); #endif } else //Retry once { #if !DBG_LOGIC Debug.Print("Retrying packet"); #endif status = RoutingGlobal.SendToParent(AppGlobal.AppPipe, routedMsg, rcvSize); if (status != 999) { Debug.Print("Send Successful"); //tmpBest.UpdateNumTriesInCurrentWindow(1); #if !DBG_LOGIC //Debug.Print("Updated numTriesInCurrentWindow for TempParent " + AppGlobal.TempParent + "; new value = " + tmpBest.GetNumTriesInCurrentWindow()); #endif } } } #endregion #elif BASE_STATION _packetNumber = sndNumber; _TTL = TTL; _payloadLength = payloadLength; _destination = originator; //Debug.Print("Base serial output: " + rcvString); _serialComm.Write(sendPayload); /* * var rcvString = new string(System.Text.Encoding.UTF8.GetChars(rcvPayloadBytes)); * Debug.Print("Base serial output: " + rcvString); * _serialComm.Write(rcvString); * * //wait for reply * int rcvSize = AppGlobal.MoteMessages.Length.SendPacket(pathLength, payloadLength); * classificationType = AppGlobal.ClassificationType.Recieve; * byte[] rcvPayload; * if (payloadLength == 1) * { * rcvPayload = BitConverter.GetBytes(GetBaseReply(sendPayload)); * } * else * { * rcvPayload = BitConverter.GetBytes('c'); * } * int rcvPayloadLength = rcvPayload.Length; * * ushort next_neighbor = path[pathLength - 1]; * * int headerSize = AppGlobal.MoteMessages.Compose.RecievePacket(rcvPayloadBytes, originator, classificationType, sndNumber, TTL, pathLength, path, payloadLength); * AppGlobal.MoteMessages.AddPayload.RecievePacket(rcvPayloadBytes, headerSize, rcvPayload, rcvPayloadLength); * #if DBG_VERBOSE * Debug.Print("Sending Packet #" + sndNumber + " to neighbor " + next_neighbor); * Debug.Print(" Classification: " + (char)classificationType); * Debug.Print(" Originator: " + originator); * Debug.Print(" path Length: " + pathLength); * Debug.Print(" payload Length: " + rcvPayloadLength + "\n"); #endif * try * { #if DBG_VERBOSE * Debug.Print("Send Successful"); #endif * var status = RoutingGlobal.SendToNeighbor(AppGlobal.AppPipe, next_neighbor, rcvPayloadBytes, rcvSize); * #if DBG_VERBOSE * Debug.Print("\n************ Detection sent to PC " + msg.Substring(1,msg.Length-2)); #endif * } * catch (Exception ex) * { * Debug.Print("SerialComm exception for Detection message [" + rcvSize + "]\n" + ex); * } */ #endif break; } case AppGlobal.MessageIds.Recieve: { AppGlobal.ClassificationType classificationType; ushort originator; ushort destination; byte TTL; ushort rcvNumber; ushort payloadLength; _lcd.Write("PRcv"); AppGlobal.MoteMessages.Parse.RecievePacket(rcvPayloadBytes, out classificationType, out rcvNumber, out originator, out destination, out TTL, out payloadLength); #if DBG_VERBOSE Debug.Print("Received Packet #" + rcvNumber + " from neighbor " + packet.Src); Debug.Print(" Classification: " + (char)classificationType); Debug.Print(" Originator: " + originator); Debug.Print(" payload Length: " + payloadLength + "\n"); #endif //Debug.Print("\tRecieve. From neighbor " + packet.Src + " # " + rcvNumber + ". Classification " + (char)classificationType + " created by " + originator + " with TTL " + TTL); #if CLIENT_NODE int rcvHeader = AppGlobal.RecieveMessageSize; byte[] rcvPayload = new byte[payloadLength]; AppGlobal.MoteMessages.getPayload.RecievePacket(rcvPayloadBytes, rcvHeader, rcvPayload, (int)payloadLength); //var rcvString = new string(System.Text.Encoding.UTF8.GetChars(rcvPayload)); //Debug.Print("Client serial output: " + rcvString); _serialComm.Write(rcvPayloadBytes); #elif RELAY_NODE // Check if originated by self or if TTL-1 = 0 if (originator == AppGlobal.AppPipe.MACRadioObj.RadioAddress || --TTL == 0) { return; } #region Uncomment when scheduler disabled // If in a reset, do not forward TODO: Change this to "spray" if (RoutingGlobal._color == Color.Red) { #if DBG_VERBOSE Debug.Print("\tIn a Reset wave... not forwarded"); #endif return; } #endregion #region Uncomment when scheduler disabled /* TODO: Uncomment lines 368-394 when not using scheduler*/ // Not originated by self. // If parent is available, pass it on int sndHeader = AppGlobal.RecieveMessageSize; byte[] sndPayload = new byte[payloadLength]; AppGlobal.MoteMessages.getPayload.SendPacket(rcvPayloadBytes, sndHeader, sndPayload, (int)payloadLength); int sendSize = sndHeader + payloadLength; var routedMsg = new byte[sendSize]; var headerSize = AppGlobal.MoteMessages.Compose.RecievePacket(routedMsg, originator, classificationType, rcvNumber, TTL, payloadLength); AppGlobal.MoteMessages.AddPayload.RecievePacket(routedMsg, headerSize, sndPayload, payloadLength); #if DBG_VERBOSE Debug.Print("Sending Packet # " + rcvNumber + " to child"); Debug.Print(" Classification: " + (char)classificationType); Debug.Print(" Originator: " + originator); Debug.Print(" payload Length: " + payloadLength + "\n"); #endif var status = RoutingGlobal.SendToChild(AppGlobal.AppPipe, destination, routedMsg, sendSize); if (status != 999) { Debug.Print("Send Successful"); RoutingGlobal.UpdateNumTriesInCurrentWindow_Parent(1); #if !DBG_LOGIC Debug.Print("Updated numTriesInCurrentWindow for Parent " + RoutingGlobal.Parent + "; new value = " + RoutingGlobal.GetNumTriesInCurrentWindow_Parent()); #endif } else //Retry once { #if !DBG_LOGIC Debug.Print("Retrying packet"); #endif status = RoutingGlobal.SendToChild(AppGlobal.AppPipe, destination, routedMsg, sendSize); if (status != 999) { Debug.Print("Send Successful"); //tmpBest.UpdateNumTriesInCurrentWindow(1); #if !DBG_LOGIC //Debug.Print("Updated numTriesInCurrentWindow for TempParent " + AppGlobal.TempParent + "; new value = " + tmpBest.GetNumTriesInCurrentWindow()); #endif } } #endregion #elif BASE_STATION #endif break; } default: Debug.Print("AppPipeReceive unknown rcvPayloadBytes[0] "); throw new ArgumentOutOfRangeException(); } #region unused ////var rcvPayloadChar = Encoding.UTF8.GetChars(rcvPayloadBytes); ////var payload = new string(rcvPayloadChar); //if (payload.Substring(0, 5).Equals("Human")) //Data packets--human //{ // Debug.Print("\n\tReceived decision: " + payload.Substring(0, 5) + "; source: " + payload.Substring(5) + "; from Node: " + packet.Src); // _lcd.Write("" + (++_numData)); //} //if (RoutingGlobal.Parent == SystemGlobal.NoParent) //{ // Debug.Print("\tNo parent specified "); // return; //} ////Debug.Print("\t\t*** Parent: "+ Parent+", SelfAddress: "+SelfAddress); //if (RoutingGlobal.Parent == _routing.SelfAddress) //{ // Debug.Print("\tAt base"); // return; //} //var toSendByte = Encoding.UTF8.GetBytes(payload); //var status = AppPipe.Send(RoutingGlobal.Parent, toSendByte, 0, (ushort)toSendByte.Length); //if (status != NetOpStatus.S_Success) //{ // Debug.Print("~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ Send status: " + status); //} //SystemGlobal.PrintNumericVals("App Snd: ", toSendByte); //Debug.Print("Forwarded to parent node: " + RoutingGlobal.Parent); #endregion } catch (Exception e) { Debug.Print(e.ToString()); } }
public static void SendDetectionMessage(AppGlobal.ClassificationType classification, int detectNum) { var msgBytes = new byte[AppGlobal.DetectionMessageSize]; var actualSize = AppGlobal.MoteMessages.Compose.Detection(msgBytes, AppGlobal.AppPipe.MACRadioObj.RadioAddress, classification, detectNum, RoutingGlobal.Infinity); #region Uncomment when not using scheduler #if DBG_VERBOSE //Debug.Print("\nAttempting send of detection message " + detectNum + " on pipe " + AppGlobal.AppPipe.PayloadType + " with classification " + (char)classification + ", size " + actualSize + " to parent " + RoutingGlobal.Parent); #elif DBG_SIMPLE Debug.Print("\nSending to " + RoutingGlobal.Parent); #endif #if DBG_VERBOSE var msgS = new System.Text.StringBuilder(); for (var i = 0; i < actualSize; i++) { msgS.Append(msgBytes[i]); msgS.Append(' '); } Debug.Print("\t" + msgS); #endif // If in a reset, do not forward TODO: Change this to "spray" if (RoutingGlobal._color == Color.Red) { #if DBG_VERBOSE || DBG_SIMPLE Debug.Print("\tIn a Reset wave... not forwarded"); #endif return; } // If parent is available, pass it on if (RoutingGlobal.IsParent) { Debug.Print("routed message len: " + msgBytes.Length); var status = RoutingGlobal.SendToParent(AppGlobal.AppPipe, msgBytes, actualSize); Debug.Print("status " + status); if (status != 999) { RoutingGlobal.UpdateNumTriesInCurrentWindow_Parent(1); #if !DBG_LOGIC Debug.Print("Updated numTriesInCurrentWindow for Parent " + RoutingGlobal.Parent + "; new value = " + RoutingGlobal.GetNumTriesInCurrentWindow_Parent()); #endif } else //Retry once { #if !DBG_LOGIC Debug.Print("Retrying packet"); #endif RoutingGlobal.CleanseCandidateTable(AppGlobal.AppPipe); Candidate tmpBest = CandidateTable.GetBestCandidate(false); AppGlobal.TempParent = tmpBest.GetMacID(); status = AppGlobal.SendToTempParent(AppGlobal.AppPipe, msgBytes, actualSize); if (status != 999) { tmpBest.UpdateNumTriesInCurrentWindow(1); #if !DBG_LOGIC Debug.Print("Updated numTriesInCurrentWindow for TempParent " + AppGlobal.TempParent + "; new value = " + tmpBest.GetNumTriesInCurrentWindow()); #endif } } } #endregion }
public static void SendPacketMessage(Object state) { Debug.Print("Timer Trigger"); _lcd.Write("Send"); ushort pathLength = 1; int payloadValue = 25000; // byte payloadValue = (byte)_rand.Next(11); // Change both for different payload sizes byte[] payload = BitConverter.GetBytes(payloadValue); int payloadLength = payload.Length; int sendSize = AppGlobal.SendMessageSize; var routedMsg = new byte[sendSize]; ushort originator = AppGlobal.AppPipe.MACRadioObj.RadioAddress; AppGlobal.ClassificationType classificationType = AppGlobal.ClassificationType.Send; byte TTL = Byte.MaxValue; ushort[] path = { originator }; var headerSize = AppGlobal.MoteMessages.Compose.SendPacket(routedMsg, originator, classificationType, _sendMsgNum, TTL, (ushort)payloadLength); // add payload AppGlobal.MoteMessages.AddPayload.SendPacket(routedMsg, headerSize, payload, payloadLength); #if DBG_SIMPLE Debug.Print("\nSending to " + RoutingGlobal.Parent); #endif // If in a reset, do not forward TODO: Change this to "spray" if (RoutingGlobal._color == Color.Red) { #if DBG_VERBOSE || DBG_SIMPLE Debug.Print("\tIn a Reset wave... not forwarded"); #endif return; } // If parent is available, pass it on if (RoutingGlobal.IsParent) { Debug.Print("routed message len: " + routedMsg.Length); var status = RoutingGlobal.SendToParent(AppGlobal.AppPipe, routedMsg, sendSize); Debug.Print("status " + status); if (status != 999) { _sendMsgNum++; RoutingGlobal.UpdateNumTriesInCurrentWindow_Parent(1); #if !DBG_LOGIC Debug.Print("Updated numTriesInCurrentWindow for Parent " + RoutingGlobal.Parent + "; new value = " + RoutingGlobal.GetNumTriesInCurrentWindow_Parent()); #endif } else //Retry once { #if !DBG_LOGIC Debug.Print("Retrying packet"); #endif RoutingGlobal.CleanseCandidateTable(AppGlobal.AppPipe); Candidate tmpBest = CandidateTable.GetBestCandidate(false); AppGlobal.TempParent = tmpBest.GetMacID(); status = AppGlobal.SendToTempParent(AppGlobal.AppPipe, routedMsg, sendSize); if (status != 999) { _sendMsgNum++; tmpBest.UpdateNumTriesInCurrentWindow(1); #if !DBG_LOGIC Debug.Print("Updated numTriesInCurrentWindow for TempParent " + AppGlobal.TempParent + "; new value = " + tmpBest.GetNumTriesInCurrentWindow()); #endif } } } }
private static void OnSendStatus(IMAC macInstance, DateTime time, SendPacketStatus ACKStatus, uint transmitDestination, ushort index) { var pipe = macInstance as MACPipe; switch (ACKStatus) { case SendPacketStatus.SendACKed: #if DBG_DIAGNOSTIC Debug.Print("\t\tApp Message Handler: Retry queue length = " + _retriedPackets.Count); #endif #if !DBG_LOGIC Debug.Print("Detect to " + transmitDestination.ToString() + " ACKed"); #endif // Update link metrics if ((ushort)transmitDestination == RoutingGlobal.Parent) { RoutingGlobal.UpdateNumReceivedInCurrentWindow_Parent(1); #if !DBG_LOGIC Debug.Print("Updated numReceivedInCurrentWindow for parent " + transmitDestination + "; new value = " + RoutingGlobal.GetNumReceivedInCurrentWindow_Parent()); #endif } else { byte cindex = CandidateTable.findIndex((ushort)transmitDestination); if (cindex < byte.MaxValue) { CandidateTable._candidateList[cindex].UpdateNumReceivedInCurrentWindow(1); #if !DBG_LOGIC Debug.Print("Updated numReceivedInCurrentWindow for candidate " + transmitDestination + "; new value = " + CandidateTable._candidateList[cindex].GetNumReceivedInCurrentWindow()); #endif } } if (_retriedPackets.Contains(index)) // If this was a re-try, remove packet from queue { _retriedPackets.Remove(index); } break; case SendPacketStatus.SendNACKed: #if !DBG_LOGIC Debug.Print("Detect to " + transmitDestination.ToString() + " NACKed"); #endif // Update link metrics if ((ushort)transmitDestination == RoutingGlobal.Parent) { RoutingGlobal.UpdateNumTriesInCurrentWindow_Parent(1); #if !DBG_LOGIC Debug.Print("Updated numTriesInCurrentWindow for parent " + transmitDestination + "; new value = " + RoutingGlobal.GetNumTriesInCurrentWindow_Parent()); #endif } else { byte cindex = CandidateTable.findIndex((ushort)transmitDestination); if (cindex < byte.MaxValue) { CandidateTable._candidateList[cindex].UpdateNumTriesInCurrentWindow(1); #if !DBG_LOGIC Debug.Print("Updated numTriesInCurrentWindow for candidate " + transmitDestination + "; new value = " + CandidateTable._candidateList[cindex].GetNumTriesInCurrentWindow()); #endif } } break; case SendPacketStatus.SendFailed: #if DBG_DIAGNOSTIC Debug.Print("\t\tApp Message Handler: Retry queue length = " + _retriedPackets.Count); #endif // Update link metrics if ((ushort)transmitDestination == RoutingGlobal.Parent) { RoutingGlobal.UpdateNumTriesInCurrentWindow_Parent(1); #if !DBG_LOGIC Debug.Print("Updated numTriesInCurrentWindow for parent " + transmitDestination + "; new value = " + RoutingGlobal.GetNumTriesInCurrentWindow_Parent()); #endif } else { byte cindex = CandidateTable.findIndex((ushort)transmitDestination); if (cindex < byte.MaxValue) { CandidateTable._candidateList[cindex].UpdateNumTriesInCurrentWindow(1); #if !DBG_LOGIC Debug.Print("Updated numTriesInCurrentWindow for candidate " + transmitDestination + "; new value = " + CandidateTable._candidateList[cindex].GetNumTriesInCurrentWindow()); #endif } } // Retry if (!_retriedPackets.Contains(index) && RoutingGlobal._color == Color.Green) // If packet not there, enqueue it and retry it once { RoutingGlobal.CleanseCandidateTable(pipe); Candidate tmpBst = CandidateTable.GetBestCandidate(false); AppGlobal.TempParent = tmpBst.GetMacID(); byte[] msg = new byte[AppGlobal.DetectionMessageSize]; if (pipe.GetMsgWithMsgID(ref msg, index) == DeviceStatus.Success) { AppGlobal.SendToTempParent(pipe, msg, msg.Length); tmpBst.UpdateNumTriesInCurrentWindow(1); #if !DBG_LOGIC Debug.Print("Updated numTriesInCurrentWindow for TempParent " + transmitDestination + "; new value = " + tmpBst.GetNumTriesInCurrentWindow()); #endif _retriedPackets.Add(index); } } else // Retried once; drop packet { _retriedPackets.Remove(index); } break; default: break; } }