Trajectory Tracking Control for Underactuated Autonomous Underwater Vehicles Using Dual Close-Loop TMPC

This paper addresses the three-dimensional (3-D) trajectory tracking of underactuated autonomous underwater vehicles (AUVs) in intricate ocean environments. A dual closed-loop tube-based model predictive control (TMPC) scheme is presented to improve trajectory tracking performance and system robustness by online optimization and state feedback, wihch considers the model uncertainties and external disturbances. There are two components to the outer-loop control law: an online control law, which is the optimal solution obtained by solving a Finite-Horizon Optimal Control Problem (FHOCP), and an offline state feedback law that guarantees the actual trajectory is in the bounded tube centered along the nominal trajectory. The inner-loop velocity controller generates feasible control inputs for the closed-loop tracking control. The controller takes the input and state constraints into account. Furthermore, the stability analysis based on the input-to-state stable (ISS) method proves that the closed-loop control system is stable. Finally, the tracking effectiveness and feasibility of the proposed controller with external disturbances have been confirmed by simulation results.