AP_NavEKF: Initialise vel and pos to zero to reduce effect of bad GPS