Path Planning for Autonomous Vehicles by Trajectory Smoothing Using Motion Primitives

We present a novel planning strategy which is applicable to high performance unmanned aerial vehicles. The proposed approach takes as input a 3-D sequence of way-points connected by straight flight trim conditions, and ldquosmoothsrdquo it in an optimal way with the goal of making it compatible with the vehicle dynamics. The smoothing step is achieved by selecting appropriate sequences of alternating trims and maneuvers from within a precomputed library of motion primitives. The resulting extremal trajectory is compatible with the vehicle and therefore trackable with small errors; furthermore, it is guaranteed to stay within the flight envelope boundary, alleviating the need for flight envelope protection systems. Yet it can be computed in real-time using closed-form expressions, all nonlinearities due to the vehicle model being confined to the stored library of motion primitives. The new method is demonstrated for the aggressive maneuvering of a helicopter.

[1]  Jonathan P. How,et al.  Hybrid Model for Trajectory Planning of Agile Autonomous Vehicles , 2004, J. Aerosp. Comput. Inf. Commun..

[2]  J. How,et al.  Receding horizon path planning with implicit safety guarantees , 2004, Proceedings of the 2004 American Control Conference.

[3]  J. B. Rosen,et al.  SQP Methods and their Application to Numerical Optimal Control , 1998 .

[4]  Carlo L. Bottasso,et al.  Adaptive planning and tracking of trajectories for the simulation of maneuvers with multibody models , 2006 .

[5]  David Filliat,et al.  Map-based navigation in mobile robots: II. A review of map-learning and path-planning strategies , 2003, Cognitive Systems Research.

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

[7]  James Archibald,et al.  Safe-Path Graph Generation for Path Planning in Urban Environments , 2003 .

[8]  Carlo L. Bottasso,et al.  Optimization of Critical Trajectories for Rotorcraft Vehicles , 2005 .

[9]  M. Borri,et al.  On Representations and Parameterizations of Motion , 2000 .

[10]  Prasad,et al.  Envelope Protection in Autonomous Unmanned Aerial Vehicles , 2003 .

[11]  Raymond W. Prouty,et al.  Helicopter performance, stability, and control , 1986 .

[12]  Anil V. Rao,et al.  Practical Methods for Optimal Control Using Nonlinear Programming , 1987 .

[13]  Brian Joseph Capozzi,et al.  Evolution-Based Path Planning and Management for Autonomous Vehicles , 2001 .

[14]  Carlo L. Bottasso,et al.  Rotorcraft Trajectory Optimization with Realizability Considerations , 2005 .

[15]  Timothy W. McLain,et al.  Real-time dynamic trajectory smoothing for unmanned air vehicles , 2005, IEEE Transactions on Control Systems Technology.

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

[17]  A. Calise,et al.  Convergence of a numerical algorithm for calculating optimal output feedback gains , 1985 .