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.
Similar content being viewed by others
References
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)
Thrun, S., Burgard, W., Fox, D.: A probabilistic approach to concurrent mapping and localization for mobile robots. Artif. Intell. 5, 253–271 (1998)
Thrun, S.: Exploration and model building in mobile robot domains. In: IEEE International Conference on Neural Networks, pp. 175–180 (1993)
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)
Moravec, H., Elfes, A.: High resolution maps from wide angle sonar. In: IEEE International Conference on Robotics and Automation, pp. 116–121 (1985)
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)
Thrun, S., Burgard, W., Fox, D.: Probabilistic Robotics. MIT Press (2005)
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)
Grisetti, G., Stachniss, C., Burgard, W.: Improved techniques for grid mapping with Rao-Blackwellized particle filters. IEEE Trans. Robot. 23, 34–46 (2007)
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)
O’Callaghan, S., Ramos, F.: Gaussian process occupancy maps. Int. J. Robot. Res. 31(1), 42–62 (2012)
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)
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)
Durrant-Whyte, H., Bailey, T.: Simultaneous localization and mapping (SLAM): Part I. IEEE Robot. Autom. Mag. 13(2), 99–110 (2006)
Bishop, C.: Pattern Recognition and Machine Learning. Springer, Berlin (2006)
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)
Karris, S.: Signals and Systems with MATLAB Applications. Orchard Publications (2003)
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)
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)
Rubinstein, E., Kroese, D.: Simulation and the Monte Carlo Method. Wiley (2008)
Ugarte, M., Militino, A., Arnholt, A.: Probability and Statistics with R. CRC Press (2008)
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)
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)
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)
Author information
Authors and Affiliations
Corresponding author
Rights and permissions
About this article
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
Received:
Accepted:
Published:
Issue Date:
DOI: https://doi.org/10.1007/s10846-014-0093-y