AP_NavEKF : covariance prediction cleanup