Fix to FlyThroughTask to allow Dubins SFP

(sub flight planner) to work.
Dubins sub flight now can choose different angles

rather than just the one "center angle."
Deprecated old greedy sub flight planner in favor of greedy dubins