Factoring the Mapping Problem: Mobile Robot Map-building in the Hybrid Spatial Semantic Hierarchy

We propose a factored approach to mobile robot map-building that handles qualitatively different types of uncertainty by combining the strengths of topological and metrical approaches. Our framework is based on a computational model of the human cognitive map; thus it allows robust navigation and communication within several different spatial ontologies. This paper focuses exclusively on the issue of map-building using the framework. Our approach factors the mapping problem into natural sub-goals: building a metrical representation for local small-scale spaces; finding a topological map that represents the qualitative structure of large-scale space; and (when necessary) constructing a metrical representation for large-scale space using the skeleton provided by the topological map. We describe how to abstract a symbolic description of the robot’s immediate surround from local metrical models, how to combine these local symbolic models in order to build global symbolic models, and how to create a globally consistent metrical map from a topological skeleton by connecting local frames of reference.

[1]  David Silver,et al.  Feature extraction for topological mine maps , 2004, 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) (IEEE Cat. No.04CH37566).

[2]  Ronald L. Rivest,et al.  Inference of finite automata using homing sequences , 1989, STOC '89.

[3]  Sebastian Thrun,et al.  FastSLAM: a factored solution to the simultaneous localization and mapping problem , 2002, AAAI/IAAI.

[4]  Benjamin Kuipers,et al.  Creating and utilizing symbolic representations of spatial knowledge using mobile robots , 2008 .

[5]  Steven M. LaValle,et al.  RRT-connect: An efficient approach to single-query path planning , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[6]  Jae-Bok Song,et al.  Real-time building of a thinning-based topological map with metric features , 2004, 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) (IEEE Cat. No.04CH37566).

[7]  Benjamin Kuipers,et al.  Towards a general theory of topological maps , 2004, Artif. Intell..

[8]  Benjamin Kuipers,et al.  Loop-closing and planarity in topological map-building , 2004, 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) (IEEE Cat. No.04CH37566).

[9]  Benjamin Kuipers,et al.  A robot exploration and mapping strategy based on a semantic hierarchy of spatial representations , 1991, Robotics Auton. Syst..

[10]  Sebastian Thrun,et al.  Robotic mapping: a survey , 2003 .

[11]  William H. Press,et al.  Numerical recipes in C++: the art of scientific computing, 2nd Edition (C++ ed., print. is corrected to software version 2.10) , 1994 .

[12]  Ching Y. Suen,et al.  A fast parallel algorithm for thinning digital patterns , 1984, CACM.

[13]  Gregory Dudek,et al.  Cooperative localization and multi-robot exploration , 2003 .

[14]  Keiji Nagatani,et al.  Topological simultaneous localization and mapping (SLAM): toward exact localization without explicit localization , 2001, IEEE Trans. Robotics Autom..

[15]  Woojin Chung,et al.  Topological map building based on thinning and its application to localization , 2002, IEEE/RSJ International Conference on Intelligent Robots and Systems.

[16]  U. Zimmer Embedding local metrical map patches in a globally consistent topological map , 2000, Proceedings of the 2000 International Symposium on Underwater Technology (Cat. No.00EX418).

[17]  Wolfram Burgard,et al.  A real-time algorithm for mobile robot mapping with applications to multi-robot and 3D mapping , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[18]  Benjamin Kuipers,et al.  Map Learning with Uninterpreted Sensors and Effectors , 1995, Artif. Intell..

[19]  Leslie Pack Kaelbling,et al.  Learning Dynamics: System Identification for Perceptually Challenged Agents , 1995, Artif. Intell..

[20]  Kevin Lynch,et al.  The Image of the City , 1960 .

[21]  Wolfram Burgard,et al.  Integrating Topological and Metric Maps for Mobile Robot Navigation: A Statistical Approach , 1998, AAAI/IAAI.

[22]  Benjamin Kuipers,et al.  Using the topological skeleton for scalable global metrical map-building , 2004, 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) (IEEE Cat. No.04CH37566).

[23]  Benjamin Kuipers,et al.  The Spatial Semantic Hierarchy , 2000, Artif. Intell..

[24]  Sebastian Thrun,et al.  Online self-calibration for mobile robots , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[25]  Benjamin Kuipers,et al.  Spatial semantic hierarchy for a physical mobile robot , 1996 .

[26]  Illah R. Nourbakhsh,et al.  Appearance-based place recognition for topological localization , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[27]  Wolfram Burgard,et al.  The dynamic window approach to collision avoidance , 1997, IEEE Robotics Autom. Mag..

[28]  Mark A. Paskin,et al.  Thin Junction Tree Filters for Simultaneous Localization and Mapping , 2002, IJCAI.

[29]  Michael Jenkin,et al.  Robotic exploration as graph construction , 1991, IEEE Trans. Robotics Autom..

[30]  DANA ANGLUIN,et al.  On the Complexity of Minimum Inference of Regular Sets , 1978, Inf. Control..

[31]  Steven Fortune,et al.  Voronoi Diagrams and Delaunay Triangulations , 2004, Handbook of Discrete and Computational Geometry, 2nd Ed..

[32]  David Silver,et al.  Towards Topological Exploration of Abandoned Mines , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[33]  Michael Bosse,et al.  An Atlas framework for scalable mapping , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[34]  Gregory Dudek,et al.  Efficient topological exploration , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[35]  Pär Buschka,et al.  An investigation of hybrid maps for mobile robots , 2005 .

[36]  Leslie Pack Kaelbling,et al.  Learning Topological Maps with Weak Local Odometric Information , 1997, IJCAI.

[37]  Wolfram Burgard,et al.  A Probabilistic Approach to Concurrent Mapping and Localization for Mobile Robots , 1998, Auton. Robots.

[38]  Edwin Olson,et al.  Fast iterative alignment of pose graphs with poor initial estimates , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[39]  Yoram Koren,et al.  The vector field histogram-fast obstacle avoidance for mobile robots , 1991, IEEE Trans. Robotics Autom..

[40]  Maja J. Mataric,et al.  Integration of representation into goal-driven behavior-based robots , 1992, IEEE Trans. Robotics Autom..

[41]  John J. Leonard,et al.  Consistent, Convergent, and Constant-Time SLAM , 2003, IJCAI.

[42]  Paul Newman,et al.  FAB-MAP: Probabilistic Localization and Mapping in the Space of Appearance , 2008, Int. J. Robotics Res..

[43]  Reid G. Simmons,et al.  Unsupervised learning of probabilistic models for robot navigation , 1996, Proceedings of IEEE International Conference on Robotics and Automation.

[44]  T. Gladwin East Is a Big Bird: Navigation and Logic on Puluwat Atoll , 1972 .

[45]  Dieter Fox,et al.  Adapting the Sample Size in Particle Filters Through KLD-Sampling , 2003, Int. J. Robotics Res..

[46]  Axel Lankenau,et al.  Self-localization in Large-Scale Environments for the Bremen Autonomous Wheelchair , 2003, Spatial Cognition.

[47]  Leslie Pack Kaelbling,et al.  Inferring finite automata with stochastic output functions and an application to map learning , 1992, 26th Annual Symposium on Foundations of Computer Science (sfcs 1985).

[48]  A. Saffiotti,et al.  Building Globally Consistent Gridmaps from Topologies , 2000 .

[49]  Sebastian Thrun,et al.  Integrating Grid-Based and Topological Maps for Mobile Robot Navigation , 1996, AAAI/IAAI, Vol. 2.

[50]  Robert E. Schapire,et al.  Design and analysis of efficient learning algorithms , 1992, ACM Doctoral dissertation award ; 1991.

[51]  Kurt Konolige,et al.  Large-Scale Map-Making , 2004, AAAI.

[52]  A. Siegel,et al.  The development of spatial representations of large-scale environments. , 1975, Advances in child development and behavior.

[53]  Wolfram Burgard,et al.  Monte Carlo Localization: Efficient Position Estimation for Mobile Robots , 1999, AAAI/IAAI.

[54]  Wolfram Burgard,et al.  Improving Grid-based SLAM with Rao-Blackwellized Particle Filters by Adaptive Proposals and Selective Resampling , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[55]  Benjamin Kuipers,et al.  Integrating Multiple Representations of Spatial Knowledge for Mapping, Navigation, and Communication , 2007, Interaction Challenges for Intelligent Assistants.

[56]  Tom Duckett,et al.  Performance Comparison of Landmark Recognition Systems for Navigating Mobile Robots , 2000, AAAI/IAAI.

[57]  Wai-Kiang Yeap Towards a Computational Theory of Cognitive Maps , 1988, Artif. Intell..

[58]  BeesonPatrick,et al.  Factoring the Mapping Problem , 2010 .

[59]  Benjamin Kuipers,et al.  A Logical Account of Causal and Topological Maps , 2001, IJCAI.

[60]  Liqiang Feng,et al.  Measurement and correction of systematic odometry errors in mobile robots , 1996, IEEE Trans. Robotics Autom..

[61]  William H. Press,et al.  The Art of Scientific Computing Second Edition , 1998 .

[62]  Luis Enrique Sucar,et al.  An Hybrid Approach to Solve the Global Localization Problem For Indoor Mobile Robots Considering Sensorms Perceptual Limitations , 2001, IJCAI.

[63]  Michael Beetz,et al.  Detection and Classification of Gateways for the Acquisition of Structured Robot Maps , 2004, DAGM-Symposium.

[64]  Benjamin Kuipers,et al.  Walk the Talk: Connecting Language, Knowledge, and Action in Route Instructions , 2006, AAAI.

[65]  Alan C. Schultz,et al.  Mobile robot exploration and map-building with continuous localization , 1998, Proceedings. 1998 IEEE International Conference on Robotics and Automation (Cat. No.98CH36146).

[66]  David Kortenkamp,et al.  Topological Mapping for Mobile Robots Using a Combination of Sonar and Vision Sensing , 1994, AAAI.

[67]  David Kortenkamp,et al.  Prototypes, Location, and Associative Networks (PLAN): Towards a Unified Theory of Cognitive Mapping , 1995, Cogn. Sci..

[68]  W. Burgard,et al.  Markov Localization for Mobile Robots in Dynamic Environments , 1999, J. Artif. Intell. Res..

[69]  Roland Siegwart,et al.  Hybrid simultaneous localization and map building: closing the loop with multi-hypotheses tracking , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[70]  Derik Schröter Region & gateway mapping: acquiring structured and object-oriented representations of indoor environments , 2006 .

[71]  Sebastian Thrun,et al.  Probabilistic Algorithms in Robotics , 2000, AI Mag..

[72]  Emanuele Menegatti,et al.  Bayesian inference in the space of topological maps , 2006, IEEE Transactions on Robotics.

[73]  Kurt Konolige,et al.  A gradient method for realtime robot control , 2000, Proceedings. 2000 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2000) (Cat. No.00CH37113).

[74]  Gregory Dudek,et al.  Creating and utilizing symbolic representations of spatial knowledge using mobile robots , 2008 .

[75]  Benjamin Kuipers,et al.  Building Local Safety Maps for a Wheelchair Robot using Vision and Lasers , 2006, The 3rd Canadian Conference on Computer and Robot Vision (CRV'06).

[76]  Jan Oliver Wallgrün,et al.  Autonomous Construction of Hierarchical Voronoi-Based Route Graph Representations , 2004, Spatial Cognition.

[77]  Wolfram Burgard,et al.  Towards Lazy Data Association in SLAM , 2003, ISRR.

[78]  Benjamin Kuipers,et al.  Modeling Spatial Knowledge , 1978, IJCAI.

[79]  Benjamin Kuipers,et al.  An Intellectual History of the Spatial Semantic Hierarchy , 2008, Robotics and Cognitive Approaches to Spatial Mapping.

[80]  Paul Newman,et al.  Probabilistic Appearance Based Navigation and Loop Closing , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[81]  Peter C. Cheeseman,et al.  Estimating uncertain spatial relationships in robotics , 1986, Proceedings. 1987 IEEE International Conference on Robotics and Automation.

[82]  Wolfram Burgard,et al.  Monte Carlo Localization with Mixture Proposal Distribution , 2000, AAAI/IAAI.

[83]  Ronald Parr,et al.  Learning probabilistic motion models for mobile robots , 2004, ICML.

[84]  Sebastian Thrun,et al.  FastSLAM 2.0: An Improved Particle Filtering Algorithm for Simultaneous Localization and Mapping that Provably Converges , 2003, IJCAI.

[85]  Sebastian Thrun,et al.  Probabilistic robotics , 2002, CACM.

[86]  Tom Duckett,et al.  Exploration of unknown environments using a compass, topological map and neural network , 1999, Proceedings 1999 IEEE International Symposium on Computational Intelligence in Robotics and Automation. CIRA'99 (Cat. No.99EX375).

[87]  F. A. Seiler,et al.  Numerical Recipes in C: The Art of Scientific Computing , 1989 .

[88]  Evangelos E. Milios,et al.  Globally Consistent Range Scan Alignment for Environment Mapping , 1997, Auton. Robots.

[89]  E. Mark Gold,et al.  Complexity of Automaton Identification from Given Data , 1978, Inf. Control..

[90]  C. M. Wang,et al.  Location estimation and uncertainty analysis for mobile robots , 1988, Proceedings. 1988 IEEE International Conference on Robotics and Automation.

[91]  Hans P. Moravec Sensor Fusion in Certainty Grids for Mobile Robots , 1988, AI Mag..

[92]  Wolfram Burgard,et al.  Robust Monte Carlo localization for mobile robots , 2001, Artif. Intell..

[93]  Wai-Kiang Yeap,et al.  Computing a Representation of the Local Environment , 1999, Artif. Intell..

[94]  William H. Press,et al.  Numerical Recipes in FORTRAN - The Art of Scientific Computing, 2nd Edition , 1987 .

[95]  P. G. Harper,et al.  The vector field , 1985 .

[96]  Gregory Dudek,et al.  Using Local Information in a Non-Local Way for Mapping Graph-Like Worlds , 1993, IJCAI.

[97]  Pat Langley,et al.  Place recognition in dynamic environments , 1997, J. Field Robotics.

[98]  Ronald Parr,et al.  DP-SLAM: Fast, Robust Simultaneous Localization and Mapping Without Predetermined Landmarks , 2003, IJCAI.

[99]  Wolfram Burgard,et al.  An efficient fastSLAM algorithm for generating maps of large-scale cyclic environments from raw laser range measurements , 2003, Proceedings 2003 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2003) (Cat. No.03CH37453).

[100]  Jeffrey Scott Vitter,et al.  Coping with Uncertainty in Map Learning , 1989, Machine Learning.

[101]  Shigeo Abe DrEng Pattern Classification , 2001, Springer London.

[102]  Benjamin Kuipers,et al.  Towards Autonomous Topological Place Detection Using the Extended Voronoi Graph , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[103]  Alberto Elfes,et al.  Occupancy grids: a probabilistic framework for robot perception and navigation , 1989 .

[104]  Vladimir Lifschitz,et al.  Nested Abnormality Theories , 1995, Artif. Intell..

[105]  David Lee,et al.  Testing finite state machines , 1991, STOC '91.

[106]  Benjamin Kuipers,et al.  Bootstrap learning for place recognition , 2002, AAAI/IAAI.

[107]  Javier González,et al.  Toward a Unified Bayesian Approach to Hybrid Metric--Topological SLAM , 2008, IEEE Transactions on Robotics.

[108]  Benjamin Kuipers,et al.  Local metrical and global topological maps in the hybrid spatial semantic hierarchy , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[109]  Frank Dellaert,et al.  Data driven MCMC for Appearance-based Topological Mapping , 2005, Robotics: Science and Systems.