Skip to main content
Log in

Pose Uncertainty in Occupancy Grids through Monte Carlo Integration

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

Abstract

We consider the dense mapping problem where a mobile robot must combine range measurements into a consistent world-centric map. If the range sensor remains fixed relative to the robot, as is usually the case, some form of simultaneous localization and mapping (SLAM) must be implemented in order to estimate the robot’s pose (position and orientation relative to the map) at every time step. Such estimates are typically characterized by uncertainty, and for safe navigation it can be important for the map to reflect the extent of those uncertainties. We present a simple and computationally tractable means of incorporating the pose distribution returned by SLAM directly into an occupancy grid map. We also indicate how our mechanism for handling pose uncertainty fits naturally into an existing adaptive grid mapping algorithm, which is more memory efficient, and offer some improvements to that algorithm. We demonstrate the effectiveness and benefits of our approach using simulated as well as real-world data.

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

Access this article

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

Instant access to the full article PDF.

Similar content being viewed by others

References

  1. Castellanos, J., Montiel, J., Neira, J., Tardós, J.: The SPmap: A probabilistic framework for simultaneous localization and map building. In: IEEE International Conference on Robotics and Automation, pp. 948–953 (1999)

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

    Google Scholar 

  3. Thrun, S.: Exploration and model building in mobile robot domains. In: IEEE International Conference on Neural Networks, pp. 175–180 (1993)

  4. Chantila, R., Laumond, J.: Position referencing and consistent world modeling for mobile robots. In: IEEE International Conference on Robotics and Automation, pp. 138–145 (1985)

  5. Moravec, H., Elfes, A.: High resolution maps from wide angle sonar. In: IEEE International Conference on Robotics and Automation, pp. 116–121 (1985)

  6. Thrun, S.: Robotic mapping: A survey. In: Lakemeyer, G., Nebel, B. (eds.) Exploring Artificial Intelligence in the New Millennium, pp 1–36. Morgan Kaufmann (2002)

  7. Thrun, S., Burgard, W., Fox, D.: Probabilistic Robotics. MIT Press (2005)

  8. Ivanjko, E., Petrović, I.: Extended Kalman filter based mobile robot pose tracking using occupancy grid maps. In: IEEE Mediterranean Electrotechnical Conference, pp. 311–314 (2004)

  9. Grisetti, G., Stachniss, C., Burgard, W.: Improved techniques for grid mapping with Rao-Blackwellized particle filters. IEEE Trans. Robot. 23, 34–46 (2007)

    Article  Google Scholar 

  10. O’Callaghan, S., Ramos, F., Durrand-Whyte, H.: Contextual occupancy maps incorporating sensor and location uncertainty. In: IEEE International Conference on Robotics and Automation, pp. 478–3485 (2010)

  11. O’Callaghan, S., Ramos, F.: Gaussian process occupancy maps. Int. J. Robot. Res. 31(1), 42–62 (2012)

    Article  Google Scholar 

  12. Merali, R., Barfoot, T.: Patch map: A benchmark for occupancy grid algorithm evaluation. In: IEEE/RSJ International Conference on Intelligent Robots and Systems, pp. 3481–3488 (2012)

  13. Einhorn, E., Schröter, C., Gross, H.: Finding the adequate resolution for grid mapping – cell size locally adapting on-the-fly. In: IEEE International Conference on Robotics and Automation, pp. 1843–1848 (2011)

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

    Article  Google Scholar 

  15. Bishop, C.: Pattern Recognition and Machine Learning. Springer, Berlin (2006)

    MATH  Google Scholar 

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

  17. Karris, S.: Signals and Systems with MATLAB Applications. Orchard Publications (2003)

  18. Andert, F.: Drawing stereo disparity images into occupancy grids: measurement model and fast implementation. In: IEEE/RSJ International Conference on Intelligent Robots and Systems, pp. 5191–5197 (2009)

  19. Beraldin, J.: Integration of laser scanning and close-range photogrammetry – the last decade and beyond. In: International Society for Photogrammetry and Remote Sensing Congress, pp. 972–983 (2004)

  20. Rubinstein, E., Kroese, D.: Simulation and the Monte Carlo Method. Wiley (2008)

  21. Ugarte, M., Militino, A., Arnholt, A.: Probability and Statistics with R. CRC Press (2008)

  22. Brink, W., Van Daalen, C., Brink, W.: FastSLAM with stereo vision. In: 23rd Annual Symposium of the Pattern Recognition Association of South Africa, pp. 24–30 (2012)

  23. Bonarini, A., Burgard, W., Fontana, G., Matteucci, M., Sorrenti, D., Tardos, J.: RAWSEEDS: Robotics advancement through web-publishing of sensorial and elaborated extensive data sets. In: Proceedings of IROS’06 Workshop on Benchmarks in Robotics Research (2006)

  24. Kohlbrecher, S., Meyer, J., Von Stryk, O., Klingauf, U.: A flexible and scalable SLAM system with full 3D motion estimation. In: IEEE International Symposium on Safety, Security and Rescue Robotics, pp. 155–160 (2011)

Download references

Author information

Authors and Affiliations

Authors

Corresponding author

Correspondence to Willie Brink.

Rights and permissions

Reprints and permissions

About this article

Check for updates. Verify currency and authenticity via CrossMark

Cite this article

Joubert, D., Brink, W. & Herbst, B. Pose Uncertainty in Occupancy Grids through Monte Carlo Integration. J Intell Robot Syst 77, 5–16 (2015). https://doi.org/10.1007/s10846-014-0093-y

Download citation

  • Received:

  • Accepted:

  • Published:

  • Issue Date:

  • DOI: https://doi.org/10.1007/s10846-014-0093-y

Keywords

Mathematics Subject Classification (2010)

Navigation