A First-Estimates Jacobian EKF for Improving SLAM Consistency
Convergence and Consistency Analysis for Extended Kalman Filter Based SLAM