Plane: smarter WP turn decision to favor into-wind

When in AUTO, and you reached a waypoint, and the next waypoint is behind you at least by a certain distance, then the left/right turn direction should take in to account the wind direction to favor into-the-wind. This would reduce the deviation from the planned mission path and favor a sharp turn that results in staying closer to the planned mission path and generally a shorter path.