TIE: Time-Informed Exploration for Robot Motion Planning

Anytime sampling-based methods are an attractive technique for solving kino-dynamic motion planning problems. These algorithms scale well to higher dimensions and can efficiently handle state and control constraints. However, an intelligent exploration strategy is required to accelerate their convergence and avoid redundant computations. Using ideas from reachability analysis, this work defines a “Time-Informed Set (TIS),” that focuses the search for time-optimal kino-dynamic planning after an initial solution is found. Such a Time-Informed Set includes all trajectories that can potentially improve the current best solution and hence exploration outside this set is redundant. Benchmarking experiments show that an exploration strategy based on the TIS can accelerate the convergence of sampling-based kino-dynamic motion planners.

[1]  Kostas E. Bekris,et al.  Sparse Methods for Efficient Asymptotically Optimal Kinodynamic Planning , 2014, WAFR.

[2]  Siddhartha S. Srinivasa,et al.  Informed Sampling for Asymptotically Optimal Path Planning , 2018, IEEE Transactions on Robotics.

[3]  Siddhartha S. Srinivasa,et al.  Batch Informed Trees (BIT*): Sampling-based optimal planning via the heuristically guided search of implicit random geometric graphs , 2014, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[4]  Marco Pavone,et al.  Fast marching tree: A fast marching sampling-based method for optimal motion planning in many dimensions , 2013, ISRR.

[5]  Emilio Frazzoli,et al.  Optimal kinodynamic motion planning using incremental sampling-based methods , 2010, 49th IEEE Conference on Decision and Control (CDC).

[6]  Somil Bansal,et al.  DeepReach: A Deep Learning Approach to High-Dimensional Reachability , 2020, 2021 IEEE International Conference on Robotics and Automation (ICRA).

[7]  Pravin Varaiya,et al.  Ellipsoidal Techniques for Reachability Analysis , 2000, HSCC.

[8]  Vijay Kumar,et al.  The GRASP Multiple Micro-UAV Testbed , 2010, IEEE Robotics & Automation Magazine.

[9]  Lydia Tapia,et al.  RL-RRT: Kinodynamic Motion Planning via Learning Reachability Estimators From RL Policies , 2019, IEEE Robotics and Automation Letters.

[10]  Baris Akgün,et al.  Sampling heuristics for optimal motion planning in high dimensions , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[11]  Jur P. van den Berg,et al.  Kinodynamic RRT*: Asymptotically optimal motion planning for robots with linear dynamics , 2013, 2013 IEEE International Conference on Robotics and Automation.

[12]  Andrea Lockerd Thomaz,et al.  Hierarchical rejection sampling for informed kinodynamic planning in high-dimensional spaces , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[13]  Siddhartha S. Srinivasa,et al.  Generalizing Informed Sampling for Asymptotically-Optimal Sampling-Based Kinodynamic Planning via Markov Chain Monte Carlo , 2018, 2018 IEEE International Conference on Robotics and Automation (ICRA).

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

[15]  Kostas E. Bekris,et al.  Efficient and Asymptotically Optimal Kinodynamic Motion Planning via Dominance-Informed Regions , 2018, 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[16]  Panagiotis Tsiotras,et al.  Machine learning guided exploration for sampling-based motion planning algorithms , 2015, 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[17]  Panagiotis Tsiotras,et al.  Use of relaxation methods in sampling-based algorithms for optimal motion planning , 2013, 2013 IEEE International Conference on Robotics and Automation.

[18]  Emilio Frazzoli,et al.  Optimal sampling-based Feedback Motion Trees among obstacles for controllable linear systems with linear constraints , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[19]  Antoine Girard,et al.  Efficient Computation of Reachable Sets of Linear Time-Invariant Systems with Inputs , 2006, HSCC.

[20]  Mo Chen,et al.  Hamilton-Jacobi reachability: A brief overview and recent advances , 2017, 2017 IEEE 56th Annual Conference on Decision and Control (CDC).

[21]  Marco Pavone,et al.  A machine learning approach for real-time reachability analysis , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[22]  Pravin Varaiya,et al.  Computation of Reach Sets for Dynamical Systems , 2010 .

[23]  Marco Pavone,et al.  Learning Sampling Distributions for Robot Motion Planning , 2017, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[24]  Emilio Frazzoli,et al.  Numerical Approach to Reachability-Guided Sampling-Based Motion Planning Under Differential Constraints , 2017, IEEE Robotics and Automation Letters.

[25]  Matthew R. Walter,et al.  Reachability-guided sampling for planning under differential constraints , 2009, 2009 IEEE International Conference on Robotics and Automation.

[26]  Marco Pavone,et al.  Optimal sampling-based motion planning under differential constraints: The drift case with linear affine dynamics , 2014, 2015 54th IEEE Conference on Decision and Control (CDC).

[27]  Leslie Pack Kaelbling,et al.  LQR-RRT*: Optimal sampling-based motion planning with automatically derived extension heuristics , 2012, 2012 IEEE International Conference on Robotics and Automation.

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

[29]  Lydia E. Kavraki,et al.  The Open Motion Planning Library , 2012, IEEE Robotics & Automation Magazine.

[30]  Kostas E. Bekris,et al.  Informed Asymptotically Near-Optimal Planning for Field Robots with Dynamics , 2017, FSR.

[31]  Lydia E. Kavraki,et al.  Benchmarking Motion Planning Algorithms: An Extensible Infrastructure for Analysis and Visualization , 2014, IEEE Robotics & Automation Magazine.