Reorganized sub flight planner folder hierarchy
SubFlightPlanner cleanup
Added "contains" method to Wayset
Added greedy  backtracking dubins sub flight planner
Set default sub-flight to backtracking dubins