Continuous Probabilistic SLAM Solved via Iterated Conditional Modes
This article proposes a simultaneous localization and mapping (SLAM) version with continuous probabilistic mapping (CP-SLAM), i.e., an algorithm of simultaneous localization and mapping that avoids the use of grids, and thus, does not require a discretized environment. A Markov random field (MRF) is considered to model this SLAM version with high spatial resolution maps. The mapping methodology is based on a point cloud generated by successive observations of the environment, which is kept bounded and representative by including a novel recursive subsampling method. The CP-SLAM problem is solved via iterated conditional modes (ICM), which is a classic algorithm with theoretical convergence over any MRF. The probabilistic maps are the most appropriate to represent dynamic environments, and can be easily implemented in other versions of the SLAM problem, such as the multi-robot version. Simulations and real experiments show the flexibility and excellent performance of this proposal.
KeywordsProbabilistic simultaneous localization and mapping (SLAM) dynamic obstacles Markov random fields (MRF) iterated conditional modes (ICM) kernel estimator
Unable to display preview. Download preview PDF.
This research was financed by Argentinean National Council for Scientific Research (CONICET) and the National University of San Juan (UNSJ) of Argentina. We also thank NVIDIA Corporation for their support.
- A. Yassin, Y. Nasser, M. Awad, A. Al-Dubai, R. Liu, C. Yuen, R. Raulefs, E. Aboutanios. Recent advances in indoor localization: A survey on theoretical approaches and applications. IEEE Communications Surveys & Tutorials, vol. 19, no. 2, pp. 1327–1346, 2017. DOI: https://doi.org/10.1109/COMST.2016.2632427.Google Scholar
- X. Yuan, J. F. Martínez-Ortega, J. A. Sánchez Fernández, M. Eckert. AEKF-SLAM: A new algorithm for robotic underwater navigation. Sensors, vol. 17, no. 5, Article number 1174, 2017. DOI: https://doi.org/10.3390/s17051174.
- J. C. Trujillo, R. Munguia, E. Guerra, A. Grau. Cooperative monocular-based SLAM for multi-UAV systems in GPS-denied environments. Sensors, vol. 18, no. 5, Article number 1351, 2018. DOI: https://doi.org/10.3390/s18051351.
- Y. Xu, T. Shen, X. Y. Chen, L. L. Bu, N. Feng. Predictive adaptive Kalman filter and its application to INS/UWB-integrated human localization with missing UWB-based measurements. International Journal of Automation and Computing, to be published. DOI: https://doi.org/10.1007/s11633-018-1157-4.
- D. M. Rosen, C. DuHadway, J. J. Leonard. A convex relaxation for approximate global optimization in simultaneous localization and mapping. In Proceedings of IEEE International Conference on Robotics and Automation, IEEE, Seattle, USA, 2015. DOI: https://doi.org/10.1109/ICRA.2015.7140014.Google Scholar
- J. M. Hammersley, P. Clifford. Markov Field on Finite Graphs and Lattices, Technical Report, Department of Statistics, Oxford University, Oxford, UK, 1971.Google Scholar
- B. Suger, G. D. Tipaldi, L. Spinello, W. Burgard. An approach to solving large-scale slam problems with a small memory footprint. In Proceedings of IEEE International Conference on Robotics and Automation, IEEE, Hong Kong, China, pp. 3632–3637, 2014. DOI: https://doi.org/10.1109/ICRA.2014.6907384.Google Scholar
- J. Gimenez, A. Amicarelli, J. M. Toibero, F. di Sciascio, R. Carelli. Iterated conditional modes to solve simultaneous localization and mapping in Markov random fields context. International Journal of Automation and Computing, vol. 15, no. 3, pp. 310–324, 2018. DOI: https://doi.org/10.1007/s11633-017-1109-4.Google Scholar
- Z. I. Botev. Kernel density estimation using Matlab, 2007. [Online], Available: https://la.mathworks.com/matlab-central/fileexchange/17204-kernel-density-estimation?focused=5829342&tabfunction, 2007.Google Scholar
- V. H. Andaluz, F. Roberti, J. M. Toibero, R. Carelli, B. Wagner. Adaptive dynamic path following control of an unicycle-like mobile robot. In Proceedings of the 4th International Conference on Intelligent Robotics and Applications, Springer, Aachen, Germany, pp. 563–574, 2011. DOI: https://doi.org/10.1007/978-3-642-25486-4_56.Google Scholar
- H. Secchi, R. Carelli, V. Mut. An experience on stable control of mobile robots. Latin American Applied Research, vol. 33, no. 4, pp. 379–385, 2003.Google Scholar