Real-Time Motion Planning for Agile Autonomous Vehicles

Planning the path of an autonomous, agile vehicle in a dynamic environment is a very complex problem, especially when the vehicle is required to use its full maneuvering capabilities. Recent efforts aimed at using randomized algorithms for planning the path of kinematic and dynamic vehicles have demonstrated considerable potential for implementation on future autonomous platforms. This paper builds upon these efforts by proposing a randomized path planning architecture for dynamical systems in the presence of fixed and moving obstacles. This architecture addresses the dynamic constraints on the vehicle's motion, and it provides at the same time a consistent decoupling between low-level control and motion planning. The path planning algorithm retains the convergence properties of its kinematic counterparts. System safety is also addressed in the face of finite computation times by analyzing the behavior of the algorithm when the available onboard computation resources are limited, and the planning must be performed in real time. The proposed algorithm can be applied to vehicles whose dynamics are described either by ordinary differential equations or by higher-level, hybrid representations. Simulation examples involving a ground robot and a small autonomous helicopter are presented and discussed.

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

[2]  Michael Athans,et al.  Optimal Control , 1966 .

[3]  George M. Siouris,et al.  Applied Optimal Control: Optimization, Estimation, and Control , 1979, IEEE Transactions on Systems, Man, and Cybernetics.

[4]  Tomás Lozano-Pérez,et al.  An algorithm for planning collision-free paths among polyhedral obstacles , 1979, CACM.

[5]  Tomás Lozano-Pérez,et al.  Automatic Planning of Manipulator Transfer Movements , 1981, IEEE Transactions on Systems, Man, and Cybernetics.

[6]  J. Schwartz,et al.  On the “piano movers'” problem I. The case of a two‐dimensional rigid polygonal body moving amidst polygonal barriers , 1983 .

[7]  Chee-Keng Yap,et al.  A "Retraction" Method for Planning the Motion of a Disc , 1985, J. Algorithms.

[8]  Oussama Khatib,et al.  Real-Time Obstacle Avoidance for Manipulators and Mobile Robots , 1986 .

[9]  Michael Lewis,et al.  Game theory for automated maneuvering during air-to-air combat , 1990 .

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

[11]  Jean-Claude Latombe,et al.  Numerical potential field techniques for robot path planning , 1991, Fifth International Conference on Advanced Robotics 'Robots in Unstructured Environments.

[12]  Jean-Claude Latombe,et al.  Robot motion planning , 1970, The Kluwer international series in engineering and computer science.

[13]  Narendra Ahuja,et al.  A potential field approach to path planning , 1992, IEEE Trans. Robotics Autom..

[14]  Daniel E. Koditschek,et al.  Exact robot navigation using artificial potential functions , 1992, IEEE Trans. Robotics Autom..

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

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

[17]  Jean-Paul Laumond,et al.  Singularities and Topological Aspects in Nonholonomic Motion Planning , 1993 .

[18]  M. Fliess,et al.  Flatness and defect of non-linear systems: introductory theory and examples , 1995 .

[19]  M. H. Overmars,et al.  A paradigm for probabilistic path planning , 1995 .

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

[21]  Lydia E. Kavraki,et al.  Analysis of probabilistic roadmaps for path planning , 1996, Proceedings of IEEE International Conference on Robotics and Automation.

[22]  Nancy M. Amato,et al.  A randomized roadmap method for path and manipulation planning , 1996, Proceedings of IEEE International Conference on Robotics and Automation.

[23]  Alexander Leonessa,et al.  Globally stabilizing controllers for multi-mode axial flow compressors via equilibria-dependent Lyapunov functions , 1997, Proceedings of the 1997 American Control Conference (Cat. No.97CH36041).

[24]  Douglas Thomson,et al.  Mathematical Definition of Helicopter Maneuvers , 1997 .

[25]  Lydia E. Kavraki,et al.  On finding narrow passages with probabilistic roadmap planners , 1998 .

[26]  S. Sastry,et al.  Output tracking control design of a helicopter model based on approximate linearization , 1998, Proceedings of the 37th IEEE Conference on Decision and Control (Cat. No.98CH36171).

[27]  Jean-Paul Laumond,et al.  Robot Motion Planning and Control , 1998 .

[28]  Lydia E. Kavraki,et al.  Randomized Query Processing in Robot Path Planning , 1998, J. Comput. Syst. Sci..

[29]  R. Murray,et al.  Real‐time trajectory generation for differentially flat systems , 1998 .

[30]  S. LaValle.  Rapidly-exploring random trees : a new tool for path planning , 1998 .

[31]  Philippe Souères,et al.  Optimal trajectories for nonholonomic mobile robots , 1998 .

[32]  Daniel E. Koditschek,et al.  Sequential Composition of Dynamically Dexterous Robot Behaviors , 1999, Int. J. Robotics Res..

[33]  Mark H. Overmars,et al.  The Gaussian sampling strategy for probabilistic roadmap planners , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[34]  Emilio Frazzoli,et al.  A hybrid control architecture for aggressive maneuvering of autonomous helicopters , 1999, Proceedings of the 38th IEEE Conference on Decision and Control (Cat. No.99CH36304).

[35]  Gregory E. Chamitoff,et al.  Autonomous Maneuver Tracking for Self-Piloted Vehicles , 1999 .

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

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

[38]  F. Bullo.  Stabilization of relative equilibria for systems on Riemannian manifolds , 1999, Proceedings of the 1999 American Control Conference (Cat. No. 99CH36251).

[39]  Rajeev Motwani,et al.  Path Planning in Expansive Configuration Spaces , 1999, Int. J. Comput. Geom. Appl..

[40]  Steven M. LaValle,et al.  RRT-connect: An efficient approach to single-query path planning , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

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

[42]  Munther A. Dahleh,et al.  A computationally efficient Lyapunov-based scheduling procedure for control of nonlinear systems with stability guarantees , 2000, IEEE Trans. Autom. Control..

[43]  Emilio Frazzoli,et al.  Trajectory tracking control design for autonomous helicopters using a backstepping algorithm , 2000, Proceedings of the 2000 American Control Conference. ACC (IEEE Cat. No.00CH36334).

[44]  Lydia E. Kavraki,et al.  Path planning using lazy PRM , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[45]  R. Murray,et al.  Trajectory Planning of Differentially Flat Systems with Dynamics and Inequalities , 2000 .

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

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