AP_NavEKF : Fix velocity hold mode