Skip to main content

Using Range and Bearing Observation in Stereo-Based EKF SLAM

  • Conference paper
  • First Online:
Towards Autonomous Robotic Systems (TAROS 2013)

Part of the book series: Lecture Notes in Computer Science ((LNAI,volume 8069))

Included in the following conference series:

  • 3157 Accesses

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.

This is a preview of subscription content, log in via an institution to check access.

Access this chapter

Chapter
USD 29.95
Price excludes VAT (USA)
  • Available as PDF
  • Read on any device
  • Instant download
  • Own it forever
eBook
USD 39.99
Price excludes VAT (USA)
  • Available as EPUB and PDF
  • Read on any device
  • Instant download
  • Own it forever
Softcover Book
USD 54.99
Price excludes VAT (USA)
  • Compact, lightweight edition
  • Dispatched in 3 to 5 business days
  • Free shipping worldwide - see info

Tax calculation will be finalised at checkout

Purchases are for personal use only

Institutional subscriptions

References

  1. 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)

    Google Scholar 

  2. 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)

    Google Scholar 

  3. 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)

    Article  Google Scholar 

  4. 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)

    Google Scholar 

  5. 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)

    Article  Google Scholar 

  6. 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)

    Google Scholar 

  7. 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)

    Google Scholar 

  8. 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)

    Google Scholar 

  9. 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)

    Google Scholar 

  10. Li, X., Aouf, N., Nemra, A.: 3D mapping based VSLAM for UAVs. In: 2012 20th MediterraneanConference on Control & Automation (MED), pp. 348–352 (2012)

    Google Scholar 

  11. 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

    Google Scholar 

  12. 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)

    Google Scholar 

  13. Paz, L., Piniés, P.: Large-scale 6-DOF SLAM with stereo-in-hand. IEEE Transactions on Robot. 24(5), 946–957 (2008)

    Article  Google Scholar 

  14. Durrant-Whyte, H., Bailey, T.: Simultaneous localization and mapping: part I. IEEE Robot. Autom. Mag. 13(2), 99–110 (2006)

    Article  Google Scholar 

  15. Karlsruhe Dataset. http://www.cvlibs.net/datasets/karlsruhe_sequences.html

  16. Geiger, A., Ziegler, J., Stiller, C.: StereoScan: dense 3d reconstruction in real-time. In: IEEE Intelligent Vehicles Symposium (IV), (Iv), pp. 963–968 (2011)

    Google Scholar 

  17. 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)

    Google Scholar 

Download references

Author information

Authors and Affiliations

Authors

Corresponding author

Correspondence to Yao-Chang Chen .

Editor information

Editors and Affiliations

Rights and permissions

Reprints 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)

Publish with us

Policies and ethics