public Autopilot(Task t, PIDSetup pidSetup)
{
PIDSetup = pidSetup;
Navigation = NavigationState.EnRoute;
Actions = Actions.None;
Task = t;
Output = new OutputController(pidSetup);
IsTruePositionWithinRadius = false;
}
public OutputController(PIDSetup setup)
{
PIDSetup = setup;
}