Novel three-dimensional optimal path planning method for vehicles with constrained pitch and yaw

Abstract

This paper presents a novel method for generating three-dimensional optimal trajectories for a vehicle or body that moves forward at a constant speed and steers in both horizontal and vertical directions. The vehicle's dynamics limit the body-frame pitch and yaw rates; additionally, the climb and decent angles of the vehicle are also bounded. Given the above constraints, the path planning problem is solved geometrically by building upon the two-dimensional Dubins curves and then Pontryagin's Maximum Principle is used to validate that the proposed solution lies within the family of candidate time-optimal trajectories. Finally, given the severe boundedness constraints on the vertical motion of the system, the robustness of the proposed path planning method is validated by naturally extending it to remain applicable to high-altitude final configurations. © Copyright Cambridge University Press 2016.