Bug fix in ground speed undershoot

The current calculation for ground speed undershoot can leave ground speed uncorrected if the wind takes the plane backwards. This change uses the component of ground speed in the yaw direction