Improving the performance of sampling-based planners by using a symmetry-exploiting gap reduction algorithm

Although sampling-based planning algorithms have been extensively used to approximately solve motion planning problems with differential constraints, gaps usually appear in their solution trajectories due to various factors. Higher precision may be requested, but as we show in this paper, this dramatically increases the computational cost. In practice, this could mean that a solution would not be found in a reasonable amount of time. In this paper, we substantially improve the performance of an RRT-based algorithm by planning low precision solutions, and then refining their quality by employing a gap reduction technique that exploits group symmetries of the system to avoid costly numerical integrations. This technique also allows PRMs to be extended to problems with differential constraints, even when no high-quality steering method exists.

[1]  Steven M. LaValle,et al.  Algorithms for Computing Numerical Optimal Feedback Motion Strategies , 2001, Int. J. Robotics Res..

[2]  Bruce Randall Donald,et al.  Kinodynamic motion planning , 1993, JACM.

[3]  Jean-Claude Latombe,et al.  Nonholonomic multibody mobile robots: Controllability and motion planning in the presence of obstacles , 2005, Algorithmica.

[4]  Kevin M. Lynch,et al.  Kinematic controllability for decoupled trajectory planning in underactuated mechanical systems , 2001, IEEE Trans. Robotics Autom..

[5]  E. Feron,et al.  Robust hybrid control for autonomous vehicle motion planning , 2000, Proceedings of the 39th IEEE Conference on Decision and Control (Cat. No.00CH37187).

[6]  Mark H. Overmars,et al.  Coordinated motion planning for multiple car-like robots using probabilistic roadmaps , 1995, Proceedings of 1995 IEEE International Conference on Robotics and Automation.

[7]  S. Sastry,et al.  Nonholonomic motion planning: steering using sinusoids , 1993, IEEE Trans. Autom. Control..

[8]  John F. Canny,et al.  An exact algorithm for kinodynamic planning in the plane , 1990, SCG '90.

[9]  Steven M. LaValle,et al.  Rapidly-Exploring Random Trees: Progress and Prospects , 2000 .

[10]  S. LaValle,et al.  Resolution completeness for sampling-based motion planning with difierential constraints , 2022 .

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

[12]  L. Shepp,et al.  OPTIMAL PATHS FOR A CAR THAT GOES BOTH FORWARDS AND BACKWARDS , 1990 .

[13]  Jean-Paul Laumond,et al.  Guidelines in nonholonomic motion planning for mobile robots , 1998 .

[14]  Bruce Randall Donald,et al.  On the complexity of kinodynamic planning , 1988, [Proceedings 1988] 29th Annual Symposium on Foundations of Computer Science.

[15]  E. Feron,et al.  Real-time motion planning for agile autonomous vehicles , 2000, Proceedings of the 2001 American Control Conference. (Cat. No.01CH37148).

[16]  K. Nomizu,et al.  Foundations of Differential Geometry , 1963 .

[17]  Bruce Randall Donald,et al.  Provably good approximation algorithms for optimal kinodynamic planning: Robots with decoupled dynamics bounds , 1995, Algorithmica.

[18]  James P. Ostrowski,et al.  Motion planning a aerial robot using rapidly-exploring random trees with dynamic constraints , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[19]  Kevin M. Lynch,et al.  Stable Pushing: Mechanics, Controllability, and Planning , 1995, Int. J. Robotics Res..

[20]  Andrew R. Teel,et al.  Feedback Stabilization of Nonlinear Systems: Sufficient Conditions and Lyapunov and Input-output Techniques , 1995 .

[21]  Antonio Bicchi,et al.  Steering driftless nonholonomic systems by control quanta , 1998, Proceedings of the 37th IEEE Conference on Decision and Control (Cat. No.98CH36171).

[22]  J. Hollerbach.  Dynamic Scaling of Manipulator Trajectories , 1983, 1983 American Control Conference.

[23]  S. Dubowsky,et al.  On the Optimal Control of Robotic Manipulators with Actuator Constraints , 1983, 1983 American Control Conference.

[24]  Florent Lamiraux,et al.  Reactive trajectory deformation for nonholonomic systems: application to mobile robots , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[25]  Kang G. Shin,et al.  Minimum-time control of robotic manipulators with geometric path constraints , 1985 .

[26]  Sonia Martínez,et al.  A catalog of inverse-kinematics planners for underactuated systems on matrix Lie groups , 2003, Proceedings 2003 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2003) (Cat. No.03CH37453).

[27]  Jean-Claude Latombe,et al.  Kinodynamic motion planning amidst moving obstacles , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[28]  Kostas E. Bekris,et al.  Probabilistic Roadmaps of Trees for Parallel Computation of Multiple Query Roadmaps , 2003, ISRR.

[29]  Gerardo Lafferriere,et al.  A Differential Geometric Approach to Motion Planning , 1993 .

[30]  S. LaValle,et al.  Sampling-Based Motion Planning With Differential Constraints , 2005 .

[31]  Emilio Frazzoli,et al.  Exploiting group symmetries to improve precision in kinodynamic and nonholonomic planning , 2003, Proceedings 2003 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2003) (Cat. No.03CH37453).

[32]  Hongyan Wang,et al.  Non-Uniform Discretization Approximations for Kinodynamic Motion Planning and its Applications , 1996 .

[33]  Miroslav Krstic,et al.  Stabilization of Nonlinear Uncertain Systems , 1998 .

[34]  S. Sastry.  Nonlinear Systems: Analysis, Stability, and Control , 1999 .

[35]  M. Fliess,et al.  Flatness, motion planning and trailer systems , 1993, Proceedings of 32nd IEEE Conference on Decision and Control.

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

[37]  Steven M. LaValle,et al.  Resolution complete rapidly-exploring random trees , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[38]  J. Canny,et al.  Nonholonomic Motion Planning , 1992 .

[39]  Barruquer Moner.  IX. References , 1971 .

[40]  Lydia E. Kavraki,et al.  Probabilistic roadmaps for path planning in high-dimensional configuration spaces , 1996, IEEE Trans. Robotics Autom..

[41]  C. Lin,et al.  Optimum Path Planning for Mechanical Manipulators , 1981 .

[42]  A. Marigo,et al.  Reachability analysis for a class of quantized control systems , 2000, Proceedings of the 39th IEEE Conference on Decision and Control (Cat. No.00CH37187).

[43]  Emilio Frazzoli,et al.  A RANDOMIZED ATTITUDE SLEW PLANNING ALGORITHM FOR AUTONOMOUS SPACECRAFT , 2001 .

[44]  John Canny,et al.  The complexity of robot motion planning , 1988 .

[45]  Antonio Bicchi,et al.  Optimal Control of Quantized Input Systems , 2002, HSCC.