Updated the way flight plans are generated

- it will add the nearest waypoint to the flight plan unless it is
closer to go straight to the destination
- there are two possibly waypoints to choose from to give variety to the
flight plans
- waypoints that are already used are omitted from the list of waypoints
to give efficiency