Abstract
Simultaneous localization and mapping (SLAM) is crucial for intelligent robot applications, especially for mobile vehicles that require accuracy of pose estimation and dense map for navigation. In this paper, we propose a novel SLAM framework based on VINS-Mono, which integrates RGB-D camera and IMU data, can perform high accuracy and robust pose estimation, and construct a dense global map at the same time. A feature tracking method fused with ORB descriptor and multi-view geometric constraints is utilized to improve the features matching accuracy and outlier removal. Depth measurements are used in back-end tightly-coupled based optimization to improve the accuracy of pose and feature depth estimation in the sliding window. Finally, the octree structure and the statistical analysis method are applied to construct the map and make the map clear and consistent. We test our system on public OpenLORIS datasets. The results show that our system has higher pose accuracy and robustness performance compared with state-of-the-art SLAM algorithms, and the map construction is accurate and clear at the same time.
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
References
Yang, D., et al.: DRE-SLAM: dynamic RGB-D encoder SLAM for a differential-drive robot. Remote Sens. 11(4) (2019). https://doi.org/10.3390/rs11040380
Yang, S., Scherer, S.: CubeSLAM: monocular 3-D object SLAM. IEEE Trans. Rob. 35(4), 925–938 (2019). https://doi.org/10.1109/TRO.2019.2909168
Piao, J.C., Kim, S.D.: Real-time visual-inertial slam based on adaptive keyframe selection for mobile AR applications. IEEE Trans. Multimedia 21(11), 2827–2836 (2019)
Durrant-Whyte, H., Bailey, T.: Simultaneous localization and mapping: part i. IEEE Robot. Autom. Mag. 13(2), 99–110 (2006)
Davison, A.J., Reid, I.D., Molton, N.D., Stasse, O.: MonoSLAM: real-time single camera slam. IEEE Trans. Pattern Anal. Mach. Intell. 29(6), 1052–1067 (2007)
Klein, G., Murray, D.: Parallel tracking and mapping for small AR workspaces. In: 2007 6th IEEE and ACM International Symposium on Mixed and Augmented Reality, pp. 225–234. IEEE (2007)
Gui, J., Gu, D., Wang, S., Hu, H.: A review of visual inertial odometry from filtering and optimisation perspectives. Adv. Robot. 29(20), 1289–1301 (2015)
Mourikis, A.I., Roumeliotis, S.I.: A multi-state constraint Kalman filter for vision-aided inertial navigation. In: Proceedings 2007 IEEE International Conference on Robotics and Automation, pp. 3565–3572. IEEE (2007)
Li, M., Mourikis, A.I.: High-precision, consistent EKF-based visual-inertial odometry. Int. J. Robot. Res. 32(6), 690–711 (2013)
Sun, K., et al.: Robust stereo visual inertial odometry for fast autonomous flight. IEEE Robot. Autom. Lett. 3(2), 965–972 (2018)
Strasdat, H., Montiel, J., Davison, A.J.: Real-time monocular slam: why filter? In: 2010 IEEE International Conference on Robotics and Automation, pp. 2657–2664. IEEE (2010)
Qin, T., Li, P., Shen, S.: VINS-Mono: a robust and versatile monocular visual-inertial state estimator. IEEE Trans. Rob. 34(4), 1004–1020 (2018)
Zou, D., Wu, Y., Pei, L., Ling, H., Yu, W.: StructVIO: visual-inertial odometry with structural regularity of man-made environments. IEEE Trans. Robot. 35(4), 999–1013 (2018)
He, Y., Zhao, J., Guo, Y., He, W., Yuan, K.: PL-VIO: tightly-coupled monocular visual-inertial odometry using point and line features. Sensors 18(4), 1159 (2018)
Zhao, X., Wang, C., Ang, M.H.: Real-time visual-inertial localization using semantic segmentation towards dynamic environments. IEEE Access 8, 155047–155059 (2020)
Wu, K.J., Guo, C.X., Georgiou, G., Roumeliotis, S.I.: VINS on wheels. In: 2017 IEEE International Conference on Robotics and Automation (ICRA), pp. 5155–5162. IEEE (2017)
Shan, Z., Li, R., Schwertfeger, S.: RGBD-inertial trajectory estimation and mapping for ground robots. Sens. (Switz.) 19(10), 1–29 (2019). https://doi.org/10.3390/s19102251
Lepetit, V., Moreno-Noguer, F., Fua, P.: EPnP: an accurate o(n) solution to the PnP problem. Int. J. Comput. Vis. 81(2), 155 (2009)
Suhr, J.K.: Kanade-Lucas-Tomasi (KLT) feature tracker. Computer Vision (EEE6503), pp. 9–18 (2009)
Fischler, M.A., Bolles, R.C.: Random sample consensus: a paradigm for model fitting with applications to image analysis and automated cartography. Commun. ACM 24(6), 381–395 (1981)
Mur-Artal, R., Montiel, J.M.M., Tardos, J.D.: ORB-SLAM: a versatile and accurate monocular SLAM system. IEEE Trans. Rob. 31(5), 1147–1163 (2015)
Author information
Authors and Affiliations
Corresponding author
Editor information
Editors and Affiliations
Rights and permissions
Copyright information
© 2022 The Author(s), under exclusive license to Springer Nature Singapore Pte Ltd.
About this paper
Cite this paper
Zhao, X., Li, Q., Wang, C., Dou, H. (2022). Real-Time Optimization-Based Dense Mapping System of RGBD-Inertial Odometry. In: Wu, M., Niu, Y., Gu, M., Cheng, J. (eds) Proceedings of 2021 International Conference on Autonomous Unmanned Systems (ICAUS 2021). ICAUS 2021. Lecture Notes in Electrical Engineering, vol 861. Springer, Singapore. https://doi.org/10.1007/978-981-16-9492-9_247
Download citation
DOI: https://doi.org/10.1007/978-981-16-9492-9_247
Published:
Publisher Name: Springer, Singapore
Print ISBN: 978-981-16-9491-2
Online ISBN: 978-981-16-9492-9
eBook Packages: Intelligent Technologies and RoboticsIntelligent Technologies and Robotics (R0)