internal virtual void SendProgressiveCommand(IProgressiveCommand args)
{
string command;
ProgressiveCommandFormatter.Load(args);
if (args.AbsoluteControlMode)
{
string message = string.Format("{0},{1},{2},{3},{4},{5},{6}", (int)ProgressiveCommandFormatter.Mode,
ProgressiveCommandFormatter.Roll, ProgressiveCommandFormatter.Pitch, ProgressiveCommandFormatter.Gaz,
ProgressiveCommandFormatter.Yaw, ProgressiveCommandFormatter.MagnetoPsi,
ProgressiveCommandFormatter.MagnetoPsiAccuracy);
command = CommandFormatter.CreateCommand(PcmdMagCommand, message);
}
else
{
string message = string.Format("{0},{1},{2},{3},{4}", (int)ProgressiveCommandFormatter.Mode,
ProgressiveCommandFormatter.Roll, ProgressiveCommandFormatter.Pitch, ProgressiveCommandFormatter.Gaz,
ProgressiveCommandFormatter.Yaw);
command = CommandFormatter.CreateCommand(PcmdCommand, message);
}
CommandQueue.Enqueue(command);
}
public virtual void SendFlatTrimCommand()
{
string command = CommandFormatter.CreateCommand(FtrimCommand);
CommandQueue.Enqueue(command);
}
private void SendPModeCommand(int mode)
{
string command = CommandFormatter.CreateCommand(PmodeCommand, mode.ToString());
CommandQueue.Enqueue(command);
}
private void SendMiscellaneousCommand(string message)
{
string command = CommandFormatter.CreateCommand(MiscCommand, message);
CommandQueue.Enqueue(command);
}
internal virtual void SendResetWatchDogCommand()
{
string command = CommandFormatter.CreateCommand(ComwdgCommand);
CommandQueue.Enqueue(command);
}
internal virtual void SendCalibrateCompassCommand()
{
string command = CommandFormatter.CreateCommand(CalibCommand, "0");
CommandQueue.Enqueue(command);
}
public virtual void SendRefCommand(RefCommands refCommand)
{
string command = CommandFormatter.CreateCommand(RefCommand, ((int)refCommand).ToString());
CommandQueue.Enqueue(command);
}
public virtual void SendConfigCommand(string key, string value)
{
var command = CreateConfigCommand(key, value);
CommandQueue.Enqueue(command);
}
public void InitializeTests()
{
_target = new CommandQueue();
}
