Started to change flightplans

Decides on first waypoint based on entry point. If the distance from
the entry to a waypoint is less than 400, it becomes a candidate. A
candidate is then chosen and added to the flight plan.