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;
}
}
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
}
/// <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 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
}
}
}
}