public void HandleServosMessage(byte[] buffer)
{
if (InvokeRequired)
{
Invoke(new DGuiCallBuffer(HandleServosMessage), buffer);
return;
}
string msg = "Servos Message Received: ";
for (int i = 0; i < buffer.Length; i++)
{
msg += buffer[i] + " ";
}
PostMessage(msg);
if (servos.IsConnected)
{
byte[] newbuffer = new byte[buffer.Length - 1];
for (int i = 1; i < buffer.Length; i++)
{
newbuffer[i - 1] = buffer[i];
}
servos.Send(newbuffer);
}
}
