A First-Estimates Jacobian EKF for Improving SLAM Consistency
Robocentric map joining: Improving the consistency of EKF-SLAM