AP_NavEKF : improved on-ground, in-air check and GPS yaw alignment