Planning Reliable Paths With Pose SLAM

The maps that are built by standard feature-based simultaneous localization and mapping (SLAM) methods cannot be directly used to compute paths for navigation, unless enriched with obstacle or traversability information, with the consequent increase in complexity. Here, we propose a method that directly uses the Pose SLAM graph of constraints to determine the path between two robot configurations with lowest accumulated pose uncertainty, i.e., the most reliable path to the goal. The method shows improved navigation results when compared with standard path-planning strategies over both datasets and real-world experiments.

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

[2]  Gregory S. Chirikjian,et al.  An obstacle avoidance algorithm for hyper-redundant manipulators , 1990, Proceedings., IEEE International Conference on Robotics and Automation.

[3]  Gregory S. Chirikjian,et al.  Hyper-redundant manipulator dynamics: a continuum approximation , 1994, Adv. Robotics.

[4]  B. Faverjon,et al.  Probabilistic Roadmaps for Path Planning in High-Dimensional Con(cid:12)guration Spaces , 1996 .

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

[6]  N. Nathan.  Self and will , 1997 .

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

[8]  Sebastian Thrun,et al.  Learning Metric-Topological Maps for Indoor Mobile Robot Navigation , 1998, Artif. Intell..

[9]  Ian D. Walker,et al.  A novel 'elephant's trunk' robot , 1999, 1999 IEEE/ASME International Conference on Advanced Intelligent Mechatronics (Cat. No.99TH8399).

[10]  Steven M. LaValle,et al.  Randomized Kinodynamic Planning , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[11]  Hiromi Mochiyama,et al.  The shape Jacobian of a manipulator with hyper degrees of freedom , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

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

[13]  John J. Leonard,et al.  Explore and return: experimental validation of real-time concurrent mapping and localization , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[14]  Wolfram Burgard,et al.  Autonomous exploration and mapping of abandoned mines , 2004, IEEE Robotics & Automation Magazine.

[15]  Favio R. Masson,et al.  Navigation and Mapping in Large Unstructured Environments , 2004, Int. J. Robotics Res..

[16]  Hugh F. Durrant-Whyte,et al.  Simultaneous Localization and Mapping with Sparse Extended Information Filters , 2004, Int. J. Robotics Res..

[17]  Ser Yong Lim,et al.  Adaptive joint friction compensation using a model-based operational space velocity observer , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[18]  Eduardo Mario Nebot,et al.  Simultaneous information and global motion analysis ("SIGMA") for car-like robots , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[19]  J. F. Forbes,et al.  Feedback control of hyperbolic distributed parameter systems , 2005 .

[20]  Nicholas Roy,et al.  Global A-Optimal Robot Exploration in SLAM , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[21]  Hanumant Singh,et al.  Exactly Sparse Delayed-State Filters for View-Based SLAM , 2006, IEEE Transactions on Robotics.

[22]  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..

[23]  Nicholas Roy,et al.  Adapting probabilistic roadmaps to handle uncertain maps , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[24]  Luc Van Gool,et al.  Omnidirectional Vision Based Topological Navigation , 2007, International Journal of Computer Vision.

[25]  Ian D. Walker,et al.  Practical Kinematics for Real-Time Implementation of Continuum Robots , 2006, IEEE Transactions on Robotics.

[26]  Hanumant Singh,et al.  Visually Mapping the RMS Titanic: Conservative Covariance Estimates for SLAM Information Filters , 2006, Int. J. Robotics Res..

[27]  Friedrich Fraundorfer,et al.  Topological mapping, localization and navigation using image collections , 2007, 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[28]  Ian D. Walker,et al.  A Neural Network Controller for Continuum Robots , 2007, IEEE Transactions on Robotics.

[29]  Thierry Siméon,et al.  The Stochastic Motion Roadmap: A Sampling Framework for Planning with Markov Motion Uncertainty , 2007, Robotics: Science and Systems.

[30]  Patrick H. Worley,et al.  Algorithm 888: Spherical Harmonic Transform Algorithms , 2008, TOMS.

[31]  Nicholas Roy,et al.  Planning in information space for a quadrotor helicopter in a GPS-denied environment , 2008, 2008 IEEE International Conference on Robotics and Automation.

[32]  Nicholas Roy,et al.  Efficient Optimization of Information-Theoretic Exploration in SLAM , 2008, AAAI.

[33]  Eric Walter,et al.  Reliable robust path planner , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[34]  Kurt Konolige,et al.  FrameSLAM: From Bundle Adjustment to Real-Time Visual Mapping , 2008, IEEE Transactions on Robotics.

[35]  YANQING CHEN,et al.  Algorithm 8 xx : CHOLMOD , supernodal sparse Cholesky factorization and update / downdate ∗ , 2006 .

[36]  Siddhartha S. Srinivasa,et al.  CHOMP: Gradient optimization techniques for efficient motion planning , 2009, 2009 IEEE International Conference on Robotics and Automation.

[37]  Sebastian Thrun,et al.  Autonomous driving in semi-structured environments: Mapping and planning , 2009, 2009 IEEE International Conference on Robotics and Automation.

[38]  Wolfram Burgard,et al.  Autonomous driving in a multi-level parking structure , 2009, 2009 IEEE International Conference on Robotics and Automation.

[39]  José E. Guivant,et al.  Efficient path planning in deformable maps , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[40]  N. Roy,et al.  The Belief Roadmap: Efficient Planning in Belief Space by Factoring the Covariance , 2009, Int. J. Robotics Res..

[41]  Morgan Quigley,et al.  ROS: an open-source Robot Operating System , 2009, ICRA 2009.

[42]  Florentin Wörgötter,et al.  A Novel Concept for Building a Hyper-Redundant Chain Robot , 2009, IEEE Transactions on Robotics.

[43]  Thierry Siméon,et al.  Sampling-Based Path Planning on Configuration-Space Costmaps , 2010, IEEE Transactions on Robotics.

[44]  Leslie Pack Kaelbling,et al.  Belief space planning assuming maximum likelihood observations , 2010, Robotics: Science and Systems.

[45]  Ian D. Walker,et al.  A model-based sliding mode controller for extensible continuum robots , 2010 .

[46]  Nirvana Popescu,et al.  Frequency criteria for the grasping control of a hyper-redundant robot , 2010, 2010 IEEE International Conference on Robotics and Automation.

[47]  Juan Andrade-Cetto,et al.  Information-Based Compact Pose SLAM , 2010, IEEE Transactions on Robotics.

[48]  D. Caleb Rucker,et al.  A Geometrically Exact Model for Externally Loaded Concentric-Tube Continuum Robots , 2010, IEEE Transactions on Robotics.

[49]  Ian D. Reid,et al.  Vast-scale Outdoor Navigation Using Adaptive Relative Bundle Adjustment , 2010, Int. J. Robotics Res..

[50]  Emilio Frazzoli,et al.  Sampling-based algorithms for optimal motion planning , 2011, Int. J. Robotics Res..

[51]  Juan Andrade-Cetto,et al.  Amortized constant time state estimation in Pose SLAM and hierarchical SLAM using a mixed Kalman-information filter , 2011, Robotics Auton. Syst..

[52]  Juan Andrade-Cetto,et al.  Path planning in belief space with pose SLAM , 2011, 2011 IEEE International Conference on Robotics and Automation.

[53]  Yacine Amirat,et al.  Modeling and Control of a Continuum Style Microrobot for Endovascular Surgery , 2011, IEEE Transactions on Robotics.

[54]  Yury Orlov,et al.  Exponential Stabilization of the Uncertain Wave Equation via Distributed Dynamic Input Extension , 2011, IEEE Transactions on Automatic Control.

[55]  Aldo Zini.  Robots expand delivery options with seamless integration. A growing number of forward-thinking hospitals in search of greater efficiencies are embracing automated delivery robots. , 2011, Health management technology.

[56]  A. Maidi,et al.  Boundary Control of Nonlinear Distributed Parameter Systems by Input-Output Linearization , 2011 .

[57]  José E. Guivant,et al.  Efficient global path planning during dense map deformation , 2011, 2011 IEEE International Conference on Robotics and Automation.

[58]  Nathan Michael,et al.  Persistent surveillance with a team of MAVs , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[59]  Kurt Konolige,et al.  Navigation in hybrid metric-topological maps , 2011, 2011 IEEE International Conference on Robotics and Automation.

[60]  Nicholas Roy,et al.  Rapidly-exploring Random Belief Trees for motion planning under uncertainty , 2011, 2011 IEEE International Conference on Robotics and Automation.

[61]  Jaime Valls Miró,et al.  Active Pose SLAM , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.