A First-Estimates Jacobian EKF for Improving SLAM Consistency
Analysis and improvement of the consistency of extended Kalman filter based SLAM