Skip to main content
SpringerLink
Log in

A Hybrid Bayesian-Frequentist Approach to SLAM

  • Published:
Journal of Intelligent & Robotic Systems Aims and scope Submit manuscript

Abstract

A hybrid Bayesian/ frequentist approach is presented for the Simultaneous Localization and Mapping Problem (SLAM). A frequentist approach is proposed for mapping a dense environment when the robotic pose is known and then extended to the case when the pose is uncertain. The SLAM problem is then solved in two steps: 1) the robot is localized with respect to a sparse set of landmarks in the map using a Bayes filter and a belief on the robot pose is formed, and 2) this belief on the robot pose is used to map the rest of the map using the frequentist estimator. The frequentist part of the hybrid methodology is shown to have complexity linear (constant time complexity under the assumption of bounded noise) in the map components, is robust to the data association problem and is provably consistent. The complexity of the Bayesian part is kept under control owing to the sparseness of the features, which also improves the robustness of the technique to the issue of data association. The hybrid method is tested on standard datasets on the RADISH repository.

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

Access this article

Log in via an institution

Price excludes VAT (USA)
Tax calculation will be finalised during checkout.

Instant access to the full article PDF.

Institutional subscriptions

Similar content being viewed by others

References

  1. Rencken, W.: Concurrent localisation and map building for mobile robots using ultrasonic sensors. In: Proceedings of the 1993 IEEE/RSJ Int. Conference on Intelligent Robots and Systems ’93, IROS ’93, vol. 3, pp. 2192–2197 (1993)

  2. Thrun, S., Burgard, W., Fox, D.: A probabilistic approach to concurrent mapping and localization for mobile robots. Auton. Robot. 5(3–4), 253–271 (1998)

    Article  MATH  Google Scholar 

  3. Nieto, J., Guivant, J., Nebot, E.: Denseslam: Simultaneous localization and dense mapping. Int. J. Rob. Res. 25, 711–744 (2006)

    Article  Google Scholar 

  4. Montemerlo, M, Thrun, S.: Simultaneous localization and mapping with unknown data association using fastslam. In: IEEE International Conference on Robotics and Automation (1985)

  5. SkrzypczyńSki, P.: Simultaneous localization mapping: A feature-based probabilistic approach. Int. J. Appl. Math. Comput. Sci. 19(4), 575–588 (2009)

    MATH  Google Scholar 

  6. Mourikis, A., Roumeliotis, S.: Analysis of positioning uncertainty in simultaneous localization and mapping (slam). In: Proceedings of the IEEE/RSJ International Conference on Robotics and Intelligent Systems (IROS), pp. 13–20 (2004)

  7. Walter, M., Eustice, R., Leonard, J.: Exactly sparse extended information filters for feature-based slam. Int. J. Rob. Res. 26(4), 335–359 (2007)

    Article  Google Scholar 

  8. Altermatt, M., Martinelli, A., Siegwart, R., Tomatis, N.: Slam with corner features based on a relative map. In: IEEE International Conference on Intelligent Robots and Systems, pp. 1053–1058 (2004)

  9. Elfes, A.: Sonar-based real-world mapping and navigation. IEEE J. of Robotics and Automation 3 (3), 249–265 (1987)

    Article  Google Scholar 

  10. Elfes, A.: Occupancy grids: a probabilistic framework for robot perception and navigation, Ph.D. dissertation, Carnegie Mellon University, Pittsburgh. PA (1989)

  11. Moravec, H.: Sensor fusion in certainty grids for mobile robots. AI Magazine 9, 61–74 (1988)

    Google Scholar 

  12. Grisetti, G., Stachniss, C., Burgard, W.: Improving grid-based slam with rao-blackwellized particle filters by adaptive proposals and selective resampling. In: Robotics and Automation, 2005. ICRA 2005. Proceedings of the IEEE International Conference, pp. 2432–2437 (2005)

  13. Grisetti, G., Tipaldi, G., Stachniss, C., Burgard, W., Nardi, D.: Speeding up rao blackwellized slam. In: Proceedings of the IEEE International Conference on Robotics & Automation (ICRA), pp. 442–447 (2006)

  14. Stachniss, C., Hähnel, D., Burgard, W., Grisetti, G.: On actively closing loops in grid-based fastslam. Adv. Robot. 19(10), 1059–1079 (2005)

    Article  Google Scholar 

  15. Eliazar, A., Parr, R.: Dp-slam 2.0. In: Proceedings (ICRA ’04) IEEE International Conference on Robotics and Automation, vol. 2, pp. 1314–1320 (2004)

  16. Grisetti, G., Tipaldi, G., Stachniss, C., Burgard, W., Nardi, D.: Fast and accurate slam with rao-blackwellized particle filters. Robot. Auton. Syst. 55(1), 30–38 (2007)

    Article  Google Scholar 

  17. K. Wurm, C. Stachniss, G. Grisetti: Bridging the gap between feature- and grid-based slam. Robot. Auton. Syst. 58(2), 140–148 (2010). selected papers from the 2007 European Conference on Mobile Robots (ECMR ’07)

    Article  Google Scholar 

  18. Smith, R., Self, M., Cheeseman, P.: Estimating uncertain spatial relationships in robotics. Autonomous Robot Vehicles, 167–193 (1990)

  19. Leonard, J., Durrant-Whyte, H.: Simultaneous map building and localization for an autonomous mobile robot. In: IEEE/RSJ International Workshop on Intelligent Robots and Systems (IROS ’91), vol. 3, pp. 1442–1447 (1991)

  20. Csorba, M., Uhlmann, J., Durrant-Whyte, H.: New approach to simultaneous localization and dynamic map building. In: Speigle, S. A. (ed.) Navigation and Control Technologies for Unmanned Systems. SPIE, vol. 2738, pp. 26–36 (1996)

  21. Csorba, M.: Simultaneous Localization and Map Building, Ph.D. Dissertation. England, Universit of Oxford (1997)

    Google Scholar 

  22. Guivant, J., Nebot, E.: Optimization of the simultaneous localization and map-building algorithm for real-time implementation. IEEE Trans. Robot. Autom. 17(3), 242–257 (2001)

    Article  Google Scholar 

  23. Knight, J., Davison, A., Reid, I.: Towards constant time slam using postponement. In: Proceedings IEEE/RSJ International Conference on Intelligent Robots and Systems, vol. 1, pp. 405–413 (2001)

  24. Williams, S.: Efficient Solutions to Autonomous Mapping and Navigation Problems, Ph.D. Dissertation. University of Sydney, Australia (2001)

    Google Scholar 

  25. Tardos, J., Neira, J., Newman, P., Leonard, J.: Robust mapping and localization in indoor environments using sonar data. Artif. Intell. 21(4), 311–330 (2002)

    Google Scholar 

  26. Williams, B., Cummins, M., Neira, J., Newman, P., Reid, I., Tardós, J.: A comparison of loop closing techniques in monocular slam. Robot. Auton. Syst. 57(12), 1188–1197 (2009)

    Article  Google Scholar 

  27. Neira, J., Tardós, J.: Data association in stochastic mapping using the joint compatibility test. IEEE Trans. Robot. Autom. 17(6), 890–897 (2001)

    Article  Google Scholar 

  28. Montemerlo, M., Thrun, S., Koller, D., Wegbreit, B.: Fastslam: A factored solution to the simultaneous localization and mapping problem. In: Proceedings of the AAAI National Conference on Artificial Intelligence, pp. 593–598 (2002)

  29. Doucet, A., Freitas, N., Murphy, K., Russell, S.: Rao-blackwellised particle filtering for dynamic bayesian networks. In: UAI ’00: Proceedings of the 16th Conference on Uncertainty in Artificial Intelligence, pp. 176–183, San Francisco (2000)

  30. Murphy, K.: Bayesian map learning in dynamic environments. In: In Neural Information Proceedings Systems (NIPS), vol. 12, pp. 1015–1021. MIT Press (1999)

  31. Bailey, T., Durrant-Whyte, H.: Simultaneous localization and mapping: Part II. IEEE Robot. Autom. Mag., 108–117 (2006)

  32. Sim, R., Elinas, P., Little, J.: A study of the rao-blackwellised particle filter for efficient and accurate vision-based slam. Int. J. Comput. Vision 74, 303–318 (2007)

    Article  Google Scholar 

  33. Thrun, S.: Robotic mapping: A survey, in Exploring Artificial Intelligence in the New Millenium. Morgan Kaufmann, San Francisco (2002)

    Google Scholar 

  34. Thrun, S., Liu, Y., Koller, D., Ng, A., Ghahramani, Z., Durrant-Whyte, H.: Simultaneous localization and mapping with sparse extended information filters. Int. J. Robot. Res. 23(7–8), 693–716 (2004)

    Article  Google Scholar 

  35. Dempster, A.P., Laird, N.M., Rubin, D.B.: Maximum likelihood from incomplete data via the em algorithm. J. of the Royal Statistical Society. Series B (Methodological) 39(1), 1–38 (1977)

    MathSciNet  MATH  Google Scholar 

  36. Lu, F., Milios, E.: Globally consistent range scan alignment for environment mapping. Auton. Robot. 18, 249–275 (1997)

    Google Scholar 

  37. Dellaert, F., Kaess, M.: Square root slam: Simultaneous localization and mapping via square root information smoothing. Int. J. Robot. Res. 25, 1181–1203 (2006)

    Article  MATH  Google Scholar 

  38. Folkesson, J., Christensen, H. I.: Closing the loop with graphical slam. IEEE Trans. Robot. 23, 731–741 (2007)

    Article  Google Scholar 

  39. Olson, E.B.: Robust and Efficient Robotic Mapping, Ph.D. Dissertation. MA, MIT, Cambridge (2008)

    Google Scholar 

  40. Olson, E., other: Fast Iterative Optimization of Pose Graphs with Poor Initial Estimates. In: Proceedings of the IEEE International Conference Robot Automation (2006)

  41. Olson, E.: Spatially adaptive learning rates for online incremental slam. In: Proceedings Robotics:Science and Systems (2007)

  42. Chakravorty, S., Saha, R.: A frequentist approach to mapping under uncertainty. Automatica (J. of IFAC) 47(3), 477–484 (2011)

    Article  MathSciNet  MATH  Google Scholar 

  43. Saha, R.: On consistent mapping in distributed environments using mobile sensors, Ph.D. dissertation, Texas A& M University, College Station, USA (2011)

  44. Chakravorty, S., Junkins, J.: Motion planning in uncertain environments with vision-like sensors. Automatica 43(12), 2104–2111 (2007)

    Article  MathSciNet  MATH  Google Scholar 

  45. Chakravorty, S.: Intelligent exploration of unknown environments with vision like sensors. In: Proceedings IEEE/ASME International Conference on Advanced Intelligent Mechatronics, pp. 1204–1209 (2005)

  46. Chakravorty, S.: A methodology for intelligent path planning. In: Proceedings of the IEEE International Symposium on Intelligent Control, pp. 592–597 (2005)

  47. Davis, J., Chakravorty, S.. In: Proceedings 45th IEEE Conference on Decision and Control, pp. 6814– 6819 (2006)

  48. Benveniste, A., Metivier, M., Priouret, P.: Adaptive Algorithms and Stochastic Approximations. Springer, New York (1990)

    Book  MATH  Google Scholar 

  49. Kushner, H., Yin, G.: Stochastic Approximation and Recursive Algorithms and Applications. Springer, New York (2003)

    MATH  Google Scholar 

  50. Bertsekas, D.: Dynamic Programming and Optimal Control. Athena Scientific (1995)

  51. Kneip, L., Tâche, F., Caprari, G., Siegwart, R.: Characterization of the compact hokuyo urg-04lx 2d laser range scanner. In: ICRA’09: Proceedings of the 2009 IEEE international conference on Robotics and Automation. Piscataway, NJ: IEEE Press, pp. 2522–2529 (2009)

  52. Howard, A., Roy, N.: The robotics data set repository (Radish). http://radish.sourceforge.net/(2003)

  53. Cox, I.: Blanche-an experiment in guidance and navigation of an autonomous robot vehicle. IEEE Trans. Robot. Autom 7(2), 193–204 (1991)

    Article  Google Scholar 

  54. Lu, F., Milios, E.: Robot pose estimation in unknown environments by matching 2d range scans. In: Proceedings CVPR ’94. IEEE Computer Society Conference on Computer Vision and Pattern Recognition, pp. 935–938 (1994)

  55. Nieto, J., Bailey, T., Nebot, E.: Recursive scan-matching slam. Robot. Auton. Syst. 55(1), 39–49 (2007). simultaneous localisation and Map Building

    Article  Google Scholar 

  56. Arras, K., Siegwart, R.: Feature extraction and scene interpretation for map-based navigation and map building. In: Proceedings of SPIE Mobile Robotics XII, pp. 42–53 (1997)

  57. Nunez, P., Vazquez-Martin, R., del Toro, J., Bandera, A., Sandoval, F.: Feature extraction from laser scan data based on curvature estimation for mobile robotics. In: Proceedings IEEE International Conference on Robotics and Automation. ICRA., pp. 1167–1172 (2006)

  58. Nguyen, V., Gächter, S., Martinelli, A., Tomatis, N., Siegwart, R.: A comparison of line extraction algorithms using 2d range data for indoor mobile robotics. Auton. Robot 23(2), 97–111 (2007)

    Article  Google Scholar 

  59. Bahari, N., Becker, M., Firouzi, H.. In: Laser and panoramic vision data, ABCM Symposium Series in Mathematics, vol. 3, pp. 266–275 (2008)

  60. Arras, K.: Feature-based Robot Navigation in Known and Unknown Environment, Ph.D. dissertation, Swiss Federal Institure of Technology (EPFL). Luasanne, Switzerland (2003)

    Google Scholar 

  61. Newman, P.: On the Structure and Solution of the Simultaneous Localization and Map Building Problem, Ph.D. dissertation, The University of Sydney. Sydney, Australia (1999)

    Google Scholar 

Download references

Author information

Authors and Affiliations

  1. Microsoft Corporation, Seattle, WA, USA

    R. Saha

  2. Department of Aerospace Engineering, Texas A&M University, College Station, TX, USA

    S. Chakravorty

Authors
  1. R. Saha
    View author publications

    You can also search for this author in PubMed Google Scholar

  2. S. Chakravorty
    View author publications

    You can also search for this author in PubMed Google Scholar

Corresponding author

Correspondence to S. Chakravorty.

Rights and permissions

Reprints and permissions

About this article

Check for updates. Verify currency and authenticity via CrossMark

Cite this article

Saha, R., Chakravorty, S. A Hybrid Bayesian-Frequentist Approach to SLAM. J Intell Robot Syst 83, 561–583 (2016). https://doi.org/10.1007/s10846-015-0319-7

Download citation

  • Received:

  • Accepted:

  • Published:

  • Issue Date:

  • DOI: https://doi.org/10.1007/s10846-015-0319-7

Keywords

Search

Navigation