AP_InertialNav: fixed use of ahrs.get_velocity with EKF disabled