AP_NavEKF: Improved zeroing of variables during initialisation