Wind correction angle and ground speed calculation