Abstract
In most SLAM (Simultaneous Localization and Mapping) ap proaches, there is only unilateral data stream from data association (DA) to state estimation (SE), and the SE model estimates states according to the results of DA. This paper focuses on the reciprocity between DA and SE, and an incremental algorithm with inter-calibration between SE and DA is presented. Our approach uses a tree model called correspondence tree (CT) to represent the solution space of data association. CT is layered according to time steps and every node in it is a data association hypothesis for all the measurements gotten at the same time step. A best-first search with limited back-tracking is designed to find the optimal path in CT, and a state estimation approach based on the least-squares method is used to compute the cost of nodes in CT and update state estimation incrementally, so direct feedback is introduced from the SE to DA. With the interaction between DA and SE, and combining with tree pruning techniques, our approach can get accurate data association and state estimation for on-line SLAM applications.
Chapter PDF
Similar content being viewed by others
References
Frese, U.: A Discussion of Simultaneous Localization and Mapping. Autonomous Robots 20(1), 25–42 (2006)
Leonard, J., Durrant-Whyte, H.: Dynamic Map Building for an Autonomous Mobile Robot. The International Journal on Robotics Research 11(4), 286–298 (1992)
Cheeseman, P., Smith, R., Self, M.: A Stochastic Map for Uncertain Spatial Relationships. In: 4th International Symposium on Robotic Research, pp. 467–474. MIT Press, Cambridge (1987)
Häehnel, D., Burgard, W., Wegbreit, B., Thrun, S.: Toward Lazy Data Association in SLAM. Intl. J. of Robotics Research, 421–431 (2003)
Bar-Shalomand, Y., Fortmann, T.E.: Tracking and Data Association. Academic Press, San Diego (1988)
Cox, I.: A Review of Statistical Data Association Techniques for Motion Correspondence. Int’l. J. Computer Vision. 10, 53–65 (1993)
Guivant, J., Nebot, E.M.: Optimization of the Simultaneous Localization and Map Building Algorithm for Real Time Implementation. IEEE Trans. Robot. Automat. 17, 242–257 (2001)
Neira, J., Tardos, J.D.: Data Association in Atochastic Mapping Using the Joint Compatibility Test. IEEE Trans. Robot. Automat. 17, 890–897 (2001)
Zhang, S., Xie, L., Adams, M.D.: An Efficient Data Association Approach to Simultaneous Localization and Map Building. Int’l. J. Robotics Research. 24, 49–60 (2005)
Bailey, T., Nebot, E.M., Rosenblatt, J.K., Durrant-Whyte, H.F.: Data association for Mobile Robot Navigation: a Graph Theoretic Approach. In: IEEE Int. Conf. Robot. Automat, pp. 2512–2517. IEEE Press, San Francisco (2000)
Montemerlo, M., Thrun, S.: Simultaneous Localization and Mapping with Unknown Data Association Using FastSLAM. In: Proc. IEEE Int. Conf. Robotics Automation, pp. 1985–1991. IEEE Press, Los Alamitos (2003)
Dellaert, F., Kaess, M.: Square Root SAM: Simultaneous Localization and Mapping via Square Root Information Smoothing. Technical Report, Georgia Tech. (2005)
Kaess, M., Ranganathan, A., Dellaert, F.: Fast Incremental Square Root Information Smoothing. In: Intl. Joint Conf. on Artificial Intelligence, pp. 2129–2134, Hyderabad (2007)
Kaess, M., Ranganathan, A., Dellaert, F.: iSAM: Fast Incremental Smoothing and Mapping with Efficient Data Association. In: IEEE Intl. Conf. on Robotics and Automation, pp. 1670–1677. IEEE Press, Rome (2007)
Leonard, J., Cox, I., Durrant-Whyte, H.F.: Dynamic Map Building for an Autonomous Mobile Robot. Intl. J. of Robotics Research. 11, 286–289 (1992)
Kai, O.: Arras.: The CAS Robot Navigation Toolbox, http://www.cas.kth.se/toolbox
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
Ji, X., Zhang, H., Hai, D., Zheng, Z. (2009). An Incremental SLAM Algorithm with Inter-calibration between State Estimation and Data Association. In: Iocchi, L., Matsubara, H., Weitzenfeld, A., Zhou, C. (eds) RoboCup 2008: Robot Soccer World Cup XII. RoboCup 2008. Lecture Notes in Computer Science(), vol 5399. Springer, Berlin, Heidelberg. https://doi.org/10.1007/978-3-642-02921-9_9
Download citation
DOI: https://doi.org/10.1007/978-3-642-02921-9_9
Publisher Name: Springer, Berlin, Heidelberg
Print ISBN: 978-3-642-02920-2
Online ISBN: 978-3-642-02921-9
eBook Packages: Computer ScienceComputer Science (R0)