Summary
In this work, we study the inconsistency of EKF-based SLAM from the perspective of observability. We analytically prove that when the Jacobians of the system and measurement models are evaluated at the latest state estimates during every time step, the linearized error-state system employed in the EKF has observable subspace of dimension higher than that of the actual, nonlinear, SLAM system. As a result, the covariance estimates of the EKF undergo reduction in directions of the state space where no information is available, which is a primary cause of the inconsistency. Furthermore, a new “First-Estimates Jacobian” (FEJ) EKF is proposed to improve the estimator’s consistency during SLAM. The proposed algorithm performs better in terms of consistency, because when the filter Jacobians are calculated using the first-ever available estimates for each state variable, the error-state system model has an observable subspace of the same dimension as the underlying nonlinear SLAM system. The theoretical analysis is validated through both simulations and experiments.
This is a preview of subscription content, log in via an institution to check access.
Access this chapter
Tax calculation will be finalised at checkout
Purchases are for personal use only
Preview
Unable to display preview. Download preview PDF.
Similar content being viewed by others
References
Julier, S., Uhlmann, J.: A counter example to the theory of simultaneous localization and map building. In: IEEE International Conference on Robotics and Automation, Seoul, Korea, May 2001, pp. 4238–4243 (2001)
Castellanos, J.A., Neira, J., Tardos, J.: Limits to the consistency of EKF-based SLAM. In: 5th IFAC Symposium on Intelligent Autonomous Vehicles, Lisbon, Portugal, July 2004, pp. 1244–1249 (2004)
Castellanos, J.A., Martinez-Cantin, R., Tardos, J., Neira, J.: Robocentric map joining: Improving the consistency of EKF-SLAM. Robotics and Autonomous Systems 55(1), 21–29 (2007)
Bailey, T., Nieto, J., Guivant, J., Stevens, M., Nebot, E.: Consistency of the EKF-SLAM algorithm. In: IEEE/RSJ International Conference on Intelligent Robots and Systems, Beijing, China, October 2006, pp. 3562–3568 (2006)
Huang, S., Dissanayake, G.: Convergence analysis for extended Kalman filter based SLAM. In: IEEE International Conference on Robotics and Automation (ICRA), Orlando, FL, May 2006, pp. 412–417 (2006)
Huang, S., Dissanayake, G.: Convergence and consistency analysis for extended Kalman filter based SLAM. IEEE Transactions on Robotics 23(5), 1036–1049 (2007)
Bar-Shalom, Y., Li, X.R., Kirubarajan, T.: Estimation with applications to tracking and navigation. Wiley, New York (2001)
Lee, K.W., Wijesoma, W.S., Guzman, J.I.: On the observability and observability analysis of SLAM. In: IEEE/RSJ Intenational Conference on Intelligent Robots and Systems (IROS), Beijing, China, October 2006, pp. 3569–3574 (2006)
Chen, Z., Jiang, K., Hung, J.C.: Local observability matrix and its application to observability analyses. In: 16th Annual Conference of IEEE (IECON 1990), Pacific Grove, CA, November 1990, pp. 100–103 (1990)
Huang, G., Mourikis, A., Roumeliotis, S.: Genearalized analysis and improvement of the consistency for EKF-based SLAM. Technical report, University of Minnesota, Minneapolis, MN (January 2008), http://www.cs.umn.edu/~ghuang/paper/TR_slam_genconsistency.pdf
Author information
Authors and Affiliations
Editor information
Editors and Affiliations
Rights and permissions
Copyright information
© 2009 Springer-Verlag Berlin Heidelberg
About this paper
Cite this paper
Huang, G.P., Mourikis, A.I., Roumeliotis, S.I. (2009). A First-Estimates Jacobian EKF for Improving SLAM Consistency. In: Khatib, O., Kumar, V., Pappas, G.J. (eds) Experimental Robotics. Springer Tracts in Advanced Robotics, vol 54. Springer, Berlin, Heidelberg. https://doi.org/10.1007/978-3-642-00196-3_43
Download citation
DOI: https://doi.org/10.1007/978-3-642-00196-3_43
Publisher Name: Springer, Berlin, Heidelberg
Print ISBN: 978-3-642-00195-6
Online ISBN: 978-3-642-00196-3
eBook Packages: EngineeringEngineering (R0)