public void SendQueuedCommand(Command command)
{
//command.SequenceNumber = GetSequenceNumberForCommand();
//commandsToSend.Add(command.CreateCommand(FirmwareVersion));
//if (command is SetConfigurationCommand)
//{
// SetControlModeCommand controlModeCommand = new SetControlModeCommand(DroneControlMode.LogControlMode);
// controlModeCommand.SequenceNumber = GetSequenceNumberForCommand();
// commandsToSend.Add(controlModeCommand.CreateCommand(FirmwareVersion));
//}
if (command is FlightMoveCommand)
{
FlightMoveCommand moveCommand = (FlightMoveCommand)command;
this.SetFlightParameters(moveCommand.Roll, moveCommand.Pitch, moveCommand.Yaw, moveCommand.Gaz);
return;
}
queueCommands.Enqueue(command);
}
private void SendUnqueuedCommand(Command command)
{
//command.SequenceNumber = GetSequenceNumberForCommand();
//SendMessage(command.CreateCommand(FirmwareVersion));
}
void ProcessCommand(Command command)
{
if (command is FlightMoveCommand)
{
FlightMoveCommand moveCommand = (FlightMoveCommand)command;
}
}