Numerical Approach to Reachability-Guided Sampling-Based Motion Planning Under Differential Constraints

This paper presents a new method for motion planning under differential constraints by incorporating a numerically solved discretized representation of reachable state space for faster state sampling and nearest neighbor searching. The reachable state space is solved for offline and stored into a “reachable map” which can be efficiently applied in online planning. State sampling is performed only over states encompassed by the reachable map to reduce the number of unsuccessful motion validity checking queries. The nearest neighbor distance function is revised such that only reachable states are considered, with states which are unreachable or only reachable beyond a designated time horizon disregarded. This method is generalized for application to any control system, and thus can be used for vehicle models where analytical solutions cannot be found. Greater improvement is expected for more constrained systems where motion checking cost is relatively high. Simulation results are discussed for case studies on a holonomic model and a Dubins car model, both with maximum speed limitation and time included as a dimension in the configuration space, where planning speed (measured by tree growth rate) can be improved through reachability guidance in each system by at least a factor of 3 and 9, respectively.

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

[2]  Jean-Claude Latombe,et al.  Randomized Kinodynamic Motion Planning with Moving Obstacles , 2002, Int. J. Robotics Res..

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

[4]  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).

[5]  Marcelo H. Ang,et al.  Autonomous golf cars for public trial of mobility-on-demand service , 2015, 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[6]  Emilio Frazzoli,et al.  Sampling-based optimal motion planning for non-holonomic dynamical systems , 2013, 2013 IEEE International Conference on Robotics and Automation.

[7]  L. Dubins.  On Curves of Minimal Length with a Constraint on Average Curvature, and with Prescribed Initial and Terminal Positions and Tangents , 1957 .

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

[9]  Emilio Frazzoli,et al.  A Spatial-Temporal Approach for Moving Object Recognition with 2D LIDAR , 2014, ISER.

[10]  S. Zucker,et al.  Toward Efficient Trajectory Planning: The Path-Velocity Decomposition , 1986 .

[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]  Marcelo H. Ang,et al.  Autonomous vehicle planning system design under perception limitation in pedestrian environment , 2015, 2015 IEEE 7th International Conference on Cybernetics and Intelligent Systems (CIS) and IEEE Conference on Robotics, Automation and Mechatronics (RAM).

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

[14]  J. Reif.  Complexity of the Generalized Mover's Problem. , 1985 .

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

[16]  Alois Knoll,et al.  Kinodynamic motion planning with Space-Time Exploration Guided Heuristic Search for car-like robots in dynamic environments , 2015, 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[17]  Emilio Frazzoli,et al.  Synthetic 2D LIDAR for precise vehicle localization in 3D urban environment , 2013, 2013 IEEE International Conference on Robotics and Automation.

[18]  Marco Pavone,et al.  Optimal sampling-based motion planning under differential constraints: The driftless case , 2014, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[19]  Marcelo H. Ang,et al.  Moving Obstacle Avoidance Via Time-Varying Cost Map , 2013 .

[20]  Jean-Claude Latombe,et al.  Motion Planning: A Journey of Robots, Molecules, Digital Actors, and Other Artifacts , 1999, Int. J. Robotics Res..

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

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

[23]  Emilio Frazzoli,et al.  Mapping with synthetic 2D LIDAR in 3D urban environment , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.