Abstract
In this study, a novel filtering method called Randomized Sigma Point Kalman Filter (RSPKF) is introduced for feature based 3D Simultaneous Localization and Mapping (SLAM). Conventional SLAM methods are mostly based on Extended Kalman Filters (EKF) for ‘mild’ nonlinear processes and Unscented KF (UKF) or Cubature KF (CKF) for ‘aggressive’ nonlinear processes. A critical problem of the existing filtering methods is that they lead to biased estimates of the state and measurement statistics. The main purpose of this study is to propose a new local filter, RSPKF, based on stochastic integration rules providing an unbiased estimate of an integral for feature based SLAM. The simulation based on point features in 2D and experimental results based on planar features in 3D show that the RSPKF based SLAM method provides more accurate results than the traditional methods.
Access provided by Autonomous University of Puebla. Download to read the full chapter text
Chapter PDF
Similar content being viewed by others
References
Dissanayake, M.W.M.G., Newman, P., Clark, S., Durrant-Whyte, H.F., Csorba, M.: A solution to the simultaneous localization and map building (SLAM) problem. IEEE Transactions on Robotics and Automation 17, 229–241 (2001)
Thrun, W.B.S., Fox, D.: Probabilistic Robotics. MIT Press (2005)
Julier, S.J., Uhlmann, J.K.: New extension of the Kalman filter to nonlinear systems. In: Society of Photo-Optical Instrumentation Engineers (SPIE) Conference Series, vol. 3068, pp. 182–193 (1997)
Arasaratnam, I., Haykin, S.: Cubature Kalman Filters. IEEE Transactions on Automatic Control 54, 1254–1269 (2009)
Dunik, J., Straka, O., Simandl, M.: The Development of a Randomised Unscented Kalman Filter. In: Proceedings of the 18th IFAC World Congress, Milano, Italy (2011)
Genz, A., Monahan, J.: Stochastic Integration Rules for Infinite Regions. SIAM J. Sci. Comput. 19, 426–439 (1998)
Dunik, J., Simandl, M., Straka, O.: Adaptive choice of scaling parameter in derivative-free local filters. In: 13th Conference on Information Fusion (FUSION), pp. 1–8 (2010)
Fischler, M.A., Bolles, R.C.: Random Sample Consensus: A Paradigm for Model Fitting with Applications to Image Analysis and Automated Cartography. Communications of the ACM 24, 381–395 (1981)
Wulf, O.: Hannover, Leibniz University Campus, http://kos.informatik.uni-osnabrueck.de/3Dscans/
Ulas, C., Temeltas, H.: A fast and robust scan matching algorithm based on ML-NDT and feature extraction. In: International Conference on Mechatronics and Automation (ICMA), pp. 1751–1756 (2011)
Author information
Authors and Affiliations
Corresponding author
Editor information
Editors and Affiliations
Rights and permissions
Copyright information
© 2015 Springer-Verlag Berlin Heidelberg
About this paper
Cite this paper
Ulas, C., Temeltas, H. (2015). Planar-Feature Based 3D SLAM Using Randomized Sigma Point Kalman Filters. In: Choukroun, D., Oshman, Y., Thienel, J., Idan, M. (eds) Advances in Estimation, Navigation, and Spacecraft Control. ENCS 2012. Springer, Berlin, Heidelberg. https://doi.org/10.1007/978-3-662-44785-7_7
Download citation
DOI: https://doi.org/10.1007/978-3-662-44785-7_7
Publisher Name: Springer, Berlin, Heidelberg
Print ISBN: 978-3-662-44784-0
Online ISBN: 978-3-662-44785-7
eBook Packages: EngineeringEngineering (R0)