Current flight course (gps speed heading) is now calculated from speed_north and speed_east components
istead using the gps heading directly because of the gps internal lowpass.
This should yield to better wind correction during WP flight and correct readings to Navigation Data.