Added new line tracking based on circular paths, airspeed speed control and gauranteed waypoint snapshots for phase-1 mission plan
Merge with master, fixed time estimate