AP_NavEKF: added method to do snap yaw alignment from GPS vel & improved covariance initialisation