A Hierarchical Trajectory Planning Framework for Autonomous Underwater Vehicles via Spatial–Temporal Alternating Optimization
Jinjin Yan, Huiling Zhang · Robotics · 2026
Autonomous underwater vehicle (AUV) motion planning in complex three-dimensional ocean environments remains challenging due to the simultaneous requirements of obstacle avoidance, dynamic feasibility, and energy efficiency. Current approaches often decouple these factors or exhibit high computational overhead, limiting applicability in real-time or large-scale missions. This work proposes a hierarchical trajectory planning framework designed to address these coupled constraints in an integrated manner. The framework consists of two stages: (i) a current-biased sampling-based planner (CB-RRT*) is introduced to incorporate ocean current information into the path generation process. By leveraging flow field distributions, the planner improves path geometric continuity and reduces steering variations compared with benchmark algorithms; (ii) spatial–temporal alternating optimization is performed within underwater safe corridors, where Bézier curve parameterization is utilized to jointly optimize spatial shapes and temporal profiles, producing dynamically feasible and energy-efficient trajectories. Simulation results in dense obstacle fields, heterogeneous flow environments, and large-scale maps demonstrate that the proposed method reduces the maximum steering angle by up to 63% in downstream scenarios, achieving a mean maximum turning angle of 0.06 rad after optimization. The framework consistently attains the lowest energy consumption across all tests while maintaining an average computation time of 0.68 s in typical environments. These results confirm the framework’s suitability for practical AUV applications, providing a computationally efficient solution for generating safe, kinematically feasible, and energy-efficient trajectories in real-world ocean settings.