Real-Time Dynamic Dubins-Helix Method for 3-D Trajectory Smoothing

This brief presents the real-time dynamic Dubins-Helix (RDDH) method for trajectory smoothing, which consists of Dubins-Helix trajectory generation and pitch angle smoothing. The generated 3-D trajectory is called the RDDH trajectory. On one hand, the projection of 3-D trajectory on the horizontal plane is partially generated by Dubins path planner such that the curvature radius constraint is satisfied. On the other hand, the Helix curve is constructed to satisfy the pitch angle constraint, even in the case that the initial and final poses are close. Furthermore, by analyzing the relationship between the parameters and the effectiveness of the RDDH trajectory, the smoothing algorithm is designed to obtain appropriate parameters for a shorter and smoother trajectory. In the end, the numerical results show the proposed method can generate an effective trajectory under diverse initial conditions and achieve real-time computation.

[1]  Thierry Fraichard,et al.  From Reeds and Shepp's to continuous-curvature paths , 1999, IEEE Transactions on Robotics.

[2]  Paolo Gallina,et al.  A Technique to Analytically Formulate and to Solve the 2-Dimensional Constrained Trajectory Planning Problem for a Mobile Robot , 2000, J. Intell. Robotic Syst..

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

[4]  Jonathan P. How,et al.  Spacecraft trajectory planning with avoidance constraints using mixed-integer linear programming , 2002 .

[5]  Aurelio Piazzi,et al.  ${ \mmb{\eta } }^{3}$-Splines for the Smooth Path Generation of Wheeled Mobile Robots , 2007, IEEE Transactions on Robotics.

[6]  Francesco Borrelli,et al.  Decentralized Receding Horizon Control and Coordination of Autonomous Vehicle Formations , 2008, IEEE Transactions on Control Systems Technology.

[7]  Kyu Ho Park,et al.  A fast path planning by path graph optimization , 2003, IEEE Trans. Syst. Man Cybern. Part A.

[8]  Jonathan P. How,et al.  Real-Time Motion Planning With Applications to Autonomous Urban Driving , 2009, IEEE Transactions on Control Systems Technology.

[9]  Huijun Gao,et al.  Evolutionary Pinning Control and Its Application in UAV Coordination , 2012, IEEE Transactions on Industrial Informatics.

[10]  Jonathan P. How,et al.  Cooperative Distributed Robust Trajectory Optimization Using Receding Horizon MILP , 2011, IEEE Transactions on Control Systems Technology.

[11]  Antonios Tsourdos,et al.  Co-operative path planning of multiple UAVs using Dubins paths with clothoid arcs , 2010 .

[12]  S. Goddard,et al.  Localization and follow-the-leader control of a heterogeneous group of mobile robots , 2006, IEEE/ASME Transactions on Mechatronics.

[13]  Alfredo Pironti,et al.  Path Generation and Tracking in 3-D for UAVs , 2009, IEEE Transactions on Control Systems Technology.

[14]  Fethi Belkhouche,et al.  Reactive Path Planning for 3-D Autonomous Vehicles , 2012, IEEE Transactions on Control Systems Technology.

[15]  Salah Sukkarieh,et al.  An Analytical Continuous-Curvature Path-Smoothing Algorithm , 2010, IEEE Transactions on Robotics.

[16]  A. R. Babaei,et al.  Three-Dimensional Curvature-Constrained Trajectory Planning Based on In-Flight Waypoints , 2010 .

[17]  Henry Leung,et al.  A Genetic Algorithm-Inspired UUV Path Planner Based on Dynamic Programming , 2012, IEEE Transactions on Systems, Man, and Cybernetics, Part C (Applications and Reviews).

[18]  Panagiotis Tsiotras,et al.  A Beamlet-Based Graph Structure for Path Planning Using Multiscale Information , 2012, IEEE Transactions on Automatic Control.

[19]  Giorgio Guglieri,et al.  Path Planning Strategies for UAVS in 3D Environments , 2011, Journal of Intelligent & Robotic Systems.

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

[21]  Raja Sengupta,et al.  A Resource Allocation Algorithm for Multivehicle Systems With Nonholonomic Constraints , 2007, IEEE Transactions on Automation Science and Engineering.

[22]  Debasish Ghose,et al.  Optimal path planning for an aerial vehicle in 3D space , 2010, 49th IEEE Conference on Decision and Control (CDC).

[23]  M. Shanmugavel,et al.  3D Path Planning for Multiple UAVs Using Pythagorean Hodograph Curves , 2007 .

[24]  Fuchun Sun,et al.  Evolutionary route planner for unmanned air vehicles , 2005, IEEE Transactions on Robotics.

[25]  Håkan Jonsson,et al.  Planning Smooth and Obstacle-Avoiding B-Spline Paths for Autonomous Mining Vehicles , 2010, IEEE Transactions on Automation Science and Engineering.

[26]  Ching-Chih Tsai,et al.  Parallel Elite Genetic Algorithm and Its Application to Global Path Planning for Autonomous Robot Navigation , 2011, IEEE Transactions on Industrial Electronics.