An Efficient Extension to Elevation Maps for Outdoor Terrain Mapping and Loop Closing

Abstract

Elevation maps are a popular data structure for representing the environment of a mobile robot operating outdoors or on not-flat surfaces. Elevation maps store in each cell of a discrete grid the height of the surface at the corresponding place in the environment. However, the use of this 2½-dimensional representation, is disadvantageous when utilized for mapping with mobile robots operating on the ground, since vertical or overhanging objects cannot be represented appropriately. Furthermore, such objects can lead to registration errors when two elevation maps have to be matched. In this paper, an approach is proposed that allows a mobile robot to deal with vertical and overhanging objects in elevation maps. The approach classifies the points in the environment according to whether they correspond to such objects or not. Also presented is a variant of the ICP algorithm that utilizes the classification of cells during the data association. Additionally, it is shown how the constraints computed by the ICP algorithm can be applied to determine globally consistent alignments. Experiments carried out with a real robot in an outdoor environment demonstrate that the proposed approach yields highly accurate elevation maps even in the case of loops. Experimental results are presented demonstrating that that the proposed classification increases the robustness of the scan matching process.

Keywords

surface maps elevation maps outdoor robots SLAM

Get full access to this article

View all access options for this article.

References

Allen, P. , Stamos, I. , Gueorguiev, A. , Gold, E. , and Blaer, P. (2001) Avenue: Automated site modeling in urban environments . Proceedings of the 3rd Conference on Digital Imaging and Modeling, Quebec City, Canada, July, pp. 357–364 .

Allen, P. K. , Stamos, I. , Troccoli, A. , Smith, B. , Leordeanu, M. , and Hsu,Y. C. (2003) 3D modeling of historic sites using range and image data . Proceedings of the IEEE International Conference on Robotics and Automation (ICRA), Tapei, September.

Bares, J. , Hebert, M. , Kanade, T. , Krotkov, E. , Mitchell, T. , Simmons, R. , and Whittaker, W. R. L. (1989) Ambler: An autonomous rover for planetary exploration . IEEE Computer Society Press, 22(6): 18–22 .

Besl, P. J. and McKay, N. D. (1992) A method for registration of 3-d shapes . IEEE Transactions on Pattern Analysis and Machine Intelligence, 14: 239–256 .

Davison, A. J. , Gonzalez Cid, Y. , and Kita, N. (2004) Real-time 3d SLAM with wide-angle vision . Proceedings of the 5th IFAC Symposium on Intelligent Autonomous Vehicles (IAV), Lisbon, Portugal, July.

Dissanayake, G. , Newman, P. , Clark, S. , Durrant-Whyte, H. F. , and Csorba, M. (2001) A solution to the simultaneous localisation and map building (SLAM) problem . IEEE Transactions on Robotics and Automation, 17(3): 229–241 .

Früh, C. and Zakhor, A. (2004) An automated method for large-scale, ground-based city model acquisition . International Journal of Computer Vision, 60: 5–24 .

Guivant, J. and Nebot, E. (2001) Optimization of the simultaneous localization and map building algorithm for real time implementation . IEEE Transactions on Robotics and Automation, 17(3): 242–257 .

Hähnel, D. , Burgard, W. , and Thrun, S. (2003) Learning compact 3d models of indoor and outdoor environments with a mobile robot . Robotics and Autonomous Systems, 44(1): 15–27 .

10.

Hebert, M. , Caillas, C. , Krotkov, E. , Kweon, I. S. , and Kanade, T. (1989) Terrain mapping for a roving planetary explorer . Proceedings of the IEEE International Conference on Robotics and Automation (ICRA), Leven, Belgium, May, pp. 997–1002 .

11.

Huber, D. and Hebert, M. (2001) Fully automatic registration of multiple 3D data sets. IEEE Computer Society Workshop on Computer Vision Beyond the Visible Spectrum(CVBVS 2001), Kauai, Hawaii , July.

12.

Hygounenc, E. , Jung, I.-K. , Souères, P. , and Lacroix, S. (2004) The autonomous blimp project of laas-cnrs:Achievements in flight control and terrain mapping . International Journal of Robotics Research, 23(4-5): 473–511 .

13.

Kohlhepp, P., Walther, M., and Steinhaus, P. (2003) Schritthaltende 3D-Kartierung und Lokalisierung für mobile inspektionsroboter. 18. Fachgespräche AMS (in German).

14.

Lacroix, S. , Mallet, A. , Bonnafous, D. , Bauzil, G. , Fleury, S. , Herrb, M. et al. (2002) Autonomous rover navigation on unknown terrains: Functions and integration . International Journal of Robotics Research, 21(10-11): 917–942 .

15.

Levoy, M. , Pulli, K. , Curless, B. , Rusinkiewicz, S. , Koller, D.L. Pereira, M. et al. (2000) The digital Michelangelo project: 3D scanning of large statues . Proceedings SIG-GRAPH, New Orleans, July, pp. 131–144 .

16.

Liu,Y. , Emery, R. , Chakrabarti, D. , Burgard,W. , and Thrun, S. (2001) Using EM to learn 3D models with mobile robots . Proceedings of the International Conference on Machine Learning (ICML), Massachusetts, July.

17.

Lu, F. and Milios, E. (1997) Globally consistent range scan alignment for environment mapping . Autonomous Robots, 4: 333–349 .

18.

Martin, C. and Thrun, S. (2002) Online acquisition of compact volumetric maps with mobile robots . IEEE International Conference on Robotics and Automation (ICRA), Washington, May.

19.

Maybeck, P.S. (1990) The Kalman filter: An introduction to concepts. In Autonomous Robot Vehicles. I.J. Cox and G.T. Wilfang , editors, Springer Verlag .

20.

Montemerlo, M. and Thrun, S. (2004) A multi-resolution pyramid for outdoor robot terrain perception . Proceedings of the National Conference on Artificial Intelligence (AAAI), San Jose, July.

21.

Moravec, H. P. (1996) Robot spatial perception by stereoscopic vision and 3d evidence grids. Technical Report CMU-RI-TR-96-34, Carnegie Mellon University, Robotics Institute .

22.

Nüchter, A. , Lingemann, K. , Hertzberg, J. , and Surmann. H. (2005) 6d SLAM with approximate data association . Proceedings of the 12th International Conference on Advanced Robotics (ICAR), Seattle, WA, July, pp. 242–249 .

23.

Olson, C. F. (2000) Probabilistic self-localization for mobile robots . IEEE Transactions on Robotics and Automation, 16(1): 55–66 .

24.

Parra, C. , Murrieta-Cid, R. , Devy, M. , and Briot. M. (1999) 3- d modelling and robot localization from visual and range data in natural scenes . 1st International Conference on Computer Vision Systems (ICVS), Lecture Notes in Computer Science 1542, pp. 450–468 .

25.

Pervölz, K. , Nüchter, A. , Surmann, H. , and Hertzberg, J. (2004) Automatic reconstruction of colored 3d models . Proceedings Robotik, Munich, June.

26.

Pfaff, P. and Burgard, W. (2005) An efficient extension of elevation maps for outdoor terrain mapping . Proceedings of the International Conference on Field and Service Robotics (FSR), Port Douglas, QLD, July, pp. 165–176 .

27.

Samet, H. (1989) Applications of Spatial Data Structures. Addison-Wesley Publishing Inc.

28.

Singh, S. and Kelly, A. (1996) Robot planning in the space of feasible actions: Two examples . Proceedings of the IEEE International Conference on Robotics & Automation (ICRA), Minneapolis, April.

29.

Thrun, S. , Burgard, W. , and Fox, D. A real-time algorithm for mobile robot mapping with applications to multi-robot and 3D mapping . Proceedings of the IEEE International Conference on Robotics and Automation (ICRA), San Francisco, April.

30.

Thrun, S. , Hähnel, D. , Ferguson, D. , Montemerlo, M. , Triebel, R. , Burgard, W. et al. (2003a) A system for volumetric robotic mapping of abandoned mines . Proceedings of the IEEE International Conference on Robotics and Automation (ICRA).

31.

Thrun, S. , Liu, Y. , Koller, D. , Ng, A. Y. , Ghahramani, Z. , and Durant-Whyte, H. (2004) Simultaneous localization and mapping with sparse extended information filters . International Journal of Robotics Research, 23(7-8): 693–704 .

32.

Thrun, S. , Martin, C. , Liu, Y. , Hähnel, D. , Emery, R. , Montemerlo, M. et al. (2003b) A real-time expectation maximization algorithm for acquiring multiplanar maps of indoor environments with mobile robots . IEEE Transactions on Robotics and Automation, 20(3): 433–442 .

33.

Triebel, R. and Burgard, W. (2005) Improving simultaneous mapping and localization in 3d using global constraints . Proceedings of the National Conference on Artificial Intelligence (AAAI), Pittsburgh, July.

34.

Triebel, R. , Dellaert, F. and Burgard, W. (2005) Using hierarchical EM to extract planes from 3d range scans . Proceedings of the IEEE International Conference on Robotics and Automation (ICRA), Barcelona, April.

35.

Wellington, C. , Courville, A. , and Stentz, A. (2005) Interacting Markov random fields for simultaneous terrain modeling and obstacle detection . Proceedings of Robotics: Science and Systems, Cambridge, MA, June.

36.

Wulf, O. , Arras, K-A. , Christensen, H. I. , and Wagner, B. (2004) 2d mapping of cluttered indoor environments by means of 3d perception . Proceedings of the IEEE International Conference on Robotics and Automation, ICRA-04, New Orleans, April, pp. 4204–4209 .

37.

Ye, C. and Borenstein, J. (1994) A new terrain mapping method for mobile robot obstacle negotiation . Proceedings of the UGV Technology Conference at the 2002 SPIE Aero Sense Symposium, Orlando, April.

Supplementary Material

Please find the following supplemental material available below.

For Open Access articles published under a Creative Commons License, all supplemental material carries the same license as the article it is associated with.

For non-Open Access articles published, all supplemental material carries a non-exclusive license, and permission requests for re-use of supplemental material or any part of supplemental material shall be sent directly to the copyright owner as specified in the copyright notice associated with the article.

0.00 MB