AP_NavEKF : Fix bug that prevents Zacc bias state variance being updated