Abstract
In this work, we have developed a new observation model for a stereo-based simultaneous localization and mapping (SLAM) system within the standard Extended-Kalman filter (EKF) framework. The observation model was derived by using the inverse depth parameterization as the landmark model, and contributes to both bearing and range information into the EKF estimation. In this way the inherently non-linear problem cause by the camera projection equations is resolved and real depth uncertainty distribution of landmarks features can be accurately estimated. The system was tested by real-world large-scale outdoor data. Analysis results show that the landmark feature depth estimation is more stable and the uncertainty noise converges faster than the binocular stereo-based approach. We also found minor drift in the vehicle pose estimation even after extended periods demonstrating the effectiveness of the new model.
Access this chapter
Tax calculation will be finalised at checkout
Purchases are for personal use only
Similar content being viewed by others
References
Cole, D.M., Newman, P.M.: Using laser range data for 3D SLAM in outdoor environments. In: Proceedings of IEEE International Conference on Robotics and Automation (ICRA), pp. 1556–1563 (2006)
Davison, A.J.: Real-time simultaneous localisation and mapping with a single camera. In: Proceedings of Ninth IEEE International Conference on Computer Vision, vol. 2, pp. 1403–1410. IEEE (2003)
Se, S., Lowe, D., Little, J.: Mobile robot localization and mapping with uncertainty using scale-invariant visual landmarks. Int. J. Robot. Res. 21(8), 735–758 (2002)
Herath, D., Kodagoda, S., Dissanayake, G.: Simultaneous localisation and mapping: a stereo vision based approach. In: IEEE/RSJ International Conference on Intelligent Robots and Systems, pp. 922–927 (2006)
Lemaire, T., Berger, C., Jung, I.-K., Lacroix, S.: Vision-based SLAM: stereo and monocular approaches. Int. J. Comput. Vision 74(3), 343–364 (2007)
Berger, C., Lacroix, S.: Using planar facets for stereovision SLAM, intelligent robots and systems. In: IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), vol. 22, no. 26, pp. 1606–1611 (2008)
Sibley, G., Matthies, L., Sukhatme, G.: Bias reduction and filter convergence for long range stereo. In: 12th International Symposium of Robotics Research (ISRR), San Francisco, CA, USA (2005)
Sibley, G., Sukhatme, G., Matthies, L.: The iterated sigma point filter with applications to long range stereo. In: Robotics: Science and Systems II, Cambridge, USA (2006)
Tim, B., Nieto, J., Guivant, J., Stevens, M., Nebot, E.: Consistency of the EKF-SLAM algorithm. In: International Conference on Intelligent Robots and Systems (IROS), Beijing, China (2006)
Li, X., Aouf, N., Nemra, A.: 3D mapping based VSLAM for UAVs. In: 2012 20th MediterraneanConference on Control & Automation (MED), pp. 348–352 (2012)
Montiel, J.M.M., Civera, J., Davison, A.J.: Unified inverse depth parametrization for monocular slam. In: Robotics: Science and Systems, Philadelphia, USA, August 2006
Civera, J., Davison, A.J., Montiel, J.M.: Inverse depth to depth conversion for monocular SLAM. In: Proceedings of IEEE International Conference on Robotics and Automation, pp. 2778–2783. IEEE (2007)
Paz, L., Piniés, P.: Large-scale 6-DOF SLAM with stereo-in-hand. IEEE Transactions on Robot. 24(5), 946–957 (2008)
Durrant-Whyte, H., Bailey, T.: Simultaneous localization and mapping: part I. IEEE Robot. Autom. Mag. 13(2), 99–110 (2006)
Karlsruhe Dataset. http://www.cvlibs.net/datasets/karlsruhe_sequences.html
Geiger, A., Ziegler, J., Stiller, C.: StereoScan: dense 3d reconstruction in real-time. In: IEEE Intelligent Vehicles Symposium (IV), (Iv), pp. 963–968 (2011)
Civera, J., Davison, A.J., MartÃnez, M.: Structure from motion using the extended Kalman filter. In: Civera, J., Davison, A.J., Montiel, J.M.M. (eds.) Springer Tracts in Advanced Robotics, vol. 75. Springer, Heidelberg (2012)
Author information
Authors and Affiliations
Corresponding author
Editor information
Editors and Affiliations
Rights and permissions
Copyright information
© 2014 Springer-Verlag Berlin Heidelberg
About this paper
Cite this paper
Chen, YC., Lin, TH., Shih, TM. (2014). Using Range and Bearing Observation in Stereo-Based EKF SLAM. In: Natraj, A., Cameron, S., Melhuish, C., Witkowski, M. (eds) Towards Autonomous Robotic Systems. TAROS 2013. Lecture Notes in Computer Science(), vol 8069. Springer, Berlin, Heidelberg. https://doi.org/10.1007/978-3-662-43645-5_37
Download citation
DOI: https://doi.org/10.1007/978-3-662-43645-5_37
Published:
Publisher Name: Springer, Berlin, Heidelberg
Print ISBN: 978-3-662-43644-8
Online ISBN: 978-3-662-43645-5
eBook Packages: Computer ScienceComputer Science (R0)