public void parsePacket(string message)
{
AX12GoToPacket packet = new AX12GoToPacket();
packet.Code = SerialCode.AX12_GOTO;
packet.Id = Convert.ToInt32(message.Substring(2, 2), 16);
packet.Angle = Convert.ToInt32(message.Substring(4, 2), 16);
EventManager <AX12GoToPacket> .Trigger(packet);
}
public void onRecieveGoToPacket(AX12GoToPacket packet)
{
SetGoal(packet.Id, packet.Angle);
}
