Abstract
Recent research has shown that visual and inertial measurements can serve as a powerful, robust and accurate odometry source when processed by state-of-the-art algorithms. One of the main benefits of such approach is short latency, even for on-board computers working on Miniature Autonomous Vehicles (MAV). However, depending on environmental conditions or sensor motion patterns, this type of odometry may be prone to drift or even divergence. In the presented work, it is shown that employing occupancy maps can limit such undesirable behaviour while still providing pose estimate at high frequencies. This is of particular importance for highly dynamical MAV control with limited on-board numerical capabilities.
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, A., Luo, Y., Chen, L., Xu, Y.: Survey of 3D map in SLAM: localization and navigation. In: Fei, M., Ma, S., Li, X., Sun, X., Jia, L., Su, Z. (eds.) Advanced Computational Methods in Life System Modeling and Simulation, pp. 410–420. Springer, Singapore (2017). ISBN 978-981-10-6370-1
Newcombe, R.A., Izadi, S., Hilliges, O., Kim, D., Davison, A.J., Kohli, P., Shotton, J., Hodges, S., Fitzgibbon, A.: Kinectfusion: real-time dense surface mapping and tracking. In: IEEE ISMAR. IEEE, October 2011
Bloesch, M., Omari, S., Hutter, M., Siegwart, R.: Robust visual inertial odometry using a direct EKF-based approach. In: 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), pp. 298–304. IEEE (2015)
Bloesch, M., Burri, M., Omari, S., Hutter, M., Siegwart, R.: Iterated extended kalman filter based visual-inertial odometry using direct photometric feedback. Int. J. Robot. Res. 36(10), 1053–1072 (2017)
Leutenegger, S., Lynen, S., Bosse, M., Siegwart, R., Furgale, P.: Keyframe-based visual-inertial odometry using nonlinear optimization. Int. J. Robot. Res. 34(3), 314–334 (2015)
Delmerico, J., Scaramuzza, D.: A benchmark comparison of monocular visual-inertial odometry algorithms for flying robots. Memory 10, 20 (2018)
Sa, I., Kamel, M., Burri, M., Bloesch, M., Khanna, R., Popovic, M., Nieto, J., Siegwart, R.: Build your own visual-inertial drone: a cost-effective and open-source autonomous drone. IEEE Robot. Autom. Mag. 25(1), 89–103 (2018). ISSN 1070-9932
Lynen, S., Achtelik, M.W., Weiss, S., Chli, M., Siegwart, R.: A robust and modular multi-sensor fusion approach applied to MAV navigation. In: 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), pp. 3923–3929. IEEE (2013)
Hornung, A., Wurm, K.M., Bennewitz, M., Stachniss, C., Burgard, W.: OctoMap: an efficient probabilistic 3D mapping framework based on octrees. Auton. Robot. 34(3), 189–206 (2013)
Oleynikova, H., Taylor, Z., Fehr, M., Siegwart, R., Nieto, J.: Voxblox: incremental 3D Euclidean signed distance fields for on-board MAV planning. In: 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), pp. 1366–1373. IEEE (2017)
Zhang, Z., Rebecq, H., Forster, C., Scaramuzza, D.: Benefit of large field-of-view cameras for visual odometry. In: 2016 IEEE International Conference on Robotics and Automation (ICRA), pp. 801–808. IEEE (2016)
Rehder, J., Nikolic, J., Schneider, T., Hinzmann, T., Siegwart, R.: Extending kalibr: calibrating the extrinsics of multiple IMUs and of individual axes. In: 2016 IEEE International Conference on Robotics and Automation (ICRA), pp. 4304–4311. IEEE (2016)
Pathak, K., Vaskevicius, N., Poppinga, J., Pfingsthorn, M., Schwertfeger, S., Birk, A.: Fast 3D mapping by matching planes extracted from range sensor point-clouds. In: IEEE/RSJ International Conference on Intelligent Robots and Systems, IROS 2009, pp. 1150–1155. IEEE (2009)
Borkowski, A., Siemiatkowska, B., Szklarski, J.: Towards Semantic Navigation in Mobile Robotics, pp. 719–748. Springer, Heidelberg (2010). ISBN 978-3-642-17322-6
Pomerleau, F., Colas, F., Siegwart, R., Magnenat, S.: Comparing ICP variants on real-world data sets. Auton. Robot. 34(3), 133–148 (2013)
Rusu, R.B., Cousins, S.: 3D is here: point cloud library (PCL). In: IEEE International Conference on Robotics and Automation (ICRA), Shanghai, China, 9–13 May 2011 (2011)
Acknowledgments
This work was completed as part of the project titled: “DIAGSTAR – dynamically stabilized universal manipulator for unmanned aerial vehicles”. It was funded by research grant no. POIR.01.02.00-00-0084/16 supported by the National Centre for Research and Development (NCBiR), Poland.
Author information
Authors and Affiliations
Corresponding author
Editor information
Editors and Affiliations
Rights and permissions
Copyright information
© 2020 Springer Nature Switzerland AG
About this paper
Cite this paper
Szklarski, J., Ziemiecki, C., Szałtys, J., Ostrowski, M. (2020). Real-Time 3D Mapping with Visual-Inertial Odometry Pose Coupled with Localization in an Occupancy Map. In: Szewczyk, R., Zieliński, C., Kaliczyńska, M. (eds) Automation 2019. AUTOMATION 2019. Advances in Intelligent Systems and Computing, vol 920. Springer, Cham. https://doi.org/10.1007/978-3-030-13273-6_37
Download citation
DOI: https://doi.org/10.1007/978-3-030-13273-6_37
Published:
Publisher Name: Springer, Cham
Print ISBN: 978-3-030-13272-9
Online ISBN: 978-3-030-13273-6
eBook Packages: Intelligent Technologies and RoboticsIntelligent Technologies and Robotics (R0)