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