AP_NavEKF: data logging bug-fix