Plan-Time Multi-Model Switching for Motion Planning

Robot navigation through non-uniform environments requires reliable motion plan generation. The choice of planning model fidelity can significantly impact performance. Prior research has shown that reducing model fidelity saves planning time, but sacrifices execution reliability. While current adaptive hierarchical motion planning techniques are promising, we present a framework that leverages a richer set of robot motion models at plan-time. The framework chooses when to switch models and what model is most applicable within a single trajectory. For instance, more complex environment locales require higher fidelity models, while lower fidelity models are sufficient for simpler parts of the planning space, thus saving plan time. Our algorithm continuously aims to pick the model that best handles the current local environment. This effectively generates a single, mixedfidelity plan. We present results for a simulated mobile robot with attached trailer in a hospital domain. We compare using a single motion planning model to switching with our framework of multiple models. Our results demonstrate that multi-fidelity model switching increases plan-time efficiency without sacrificing execution reliability.

[1]  Alonzo Kelly,et al.  Differentially constrained motion replanning using state lattices with graduated fidelity , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[2]  Manuela M. Veloso,et al.  Real-time randomized path planning for robot navigation , 2002, IEEE/RSJ International Conference on Intelligent Robots and Systems.

[3]  Lydia E. Kavraki,et al.  Motion Planning With Dynamics by a Synergistic Combination of Layers of Planning , 2010, IEEE Transactions on Robotics.

[4]  Mike Stilman,et al.  Kinodynamic RRTs with Fixed Time Step and Best-Input Extension Are Not Probabilistically Complete , 2014, WAFR.

[5]  Maxim Likhachev,et al.  Path Planning with Adaptive Dimensionality , 2011, SOCS.

[6]  Mark H. Overmars,et al.  Multilevel Path Planning for Nonholonomic Robots Using Semiholonomic Subsystems , 1998, Int. J. Robotics Res..

[7]  Alonzo Kelly,et al.  Enhanced 3D Kinematic Modeling of Wheeled Mobile Robots , 2014, Robotics: Science and Systems.

[8]  Lydia E. Kavraki,et al.  Mobile manipulation: Encoding motion planning options using task motion multigraphs , 2011, 2011 IEEE International Conference on Robotics and Automation.

[9]  Benjamin J. Stephens,et al.  Humanoid push recovery , 2007, 2007 7th IEEE-RAS International Conference on Humanoid Robots.

[10]  Héctor H. González-Baños,et al.  Multi-modal Motion Planning for a Humanoid Robot Manipulation Task , 2007, ISRR.

[11]  Siddhartha S. Srinivasa,et al.  Physics-Based Grasp Planning Through Clutter , 2012, Robotics: Science and Systems.

[12]  Gerald L. Thompson,et al.  An Algorithm for Finding a Minimum Equivalent Graph of a Digraph , 1969, J. ACM.

[13]  A. Kelly,et al.  Adaptive model-predictive motion planning for navigation in complex environments , 2009 .

[14]  Maxim Likhachev,et al.  Planning with adaptive dimensionality for mobile manipulation , 2012, 2012 IEEE International Conference on Robotics and Automation.

[15]  Alfred V. Aho,et al.  The Transitive Reduction of a Directed Graph , 1972, SIAM J. Comput..

[16]  Manuela M. Veloso,et al.  Variable Level-Of-Detail Motion Planning in Environments with Poorly Predictable Bodies , 2010, ECAI.

[17]  Ross A. Knepper,et al.  Improved hierarchical planner performance using local path equivalence , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[18]  Sven Behnke,et al.  Multiresolution Path Planning in Dynamic Environments for the Standard Platform League , 2010 .

[19]  Jean-Claude Latombe,et al.  Multi-modal Motion Planning in Non-expansive Spaces , 2010, Int. J. Robotics Res..

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

[21]  Richard Dearden,et al.  A Switching Planner for Combined Task and Observation Planning , 2011, AAAI.

[22]  Larry S. Davis,et al.  Multiresolution path planning for mobile robots , 1986, IEEE J. Robotics Autom..

[23]  Maxim Likhachev,et al.  Incremental Planning with Adaptive Dimensionality , 2013, ICAPS.