AP_NavEKF : Fix bug in stored state vector size