3D Trajectory Tracking Based on Super-Twisting Observer and Non-Singular Terminal Sliding Mode Control for Underactuated Autonomous Underwater Vehicle

This paper addresses the three-dimensional trajectory tracking problem for underactuated autonomous underwater vehicles subject to external disturbances and model uncertainties in complex ocean environments. A robust control method integrating backstepping dynamic surface control and non-singular terminal sliding mode is proposed. Firstly, based on the kinematic and dynamic models of autonomous underwater vehicle, virtual velocity commands are constructed via backstepping approach to stabilize the position and attitude errors. To circumvent the “differential explosion” problem inherent in conventional backstepping control caused by repeated differentiations of virtual control variables, first-order low-pass filters are introduced to construct dynamic surface control, yielding smooth derivatives of virtual velocity commands. Secondly, to enhance convergence rate and robustness, a non-singular terminal sliding surface is designed at the dynamic level, and a terminal reaching law is formulated to achieve finite-time convergence of velocity tracking errors. Furthermore, to compensate for external disturbances and unmodeled dynamics, a disturbance observer based on the super-twisting algorithm is developed, enabling finite-time high-precision estimation of lumped disturbances, with the estimation results incorporated into the control law for feedforward compensation. Finally, comparative simulations are conducted under two typical disturbance scenarios. The results demonstrate that the proposed method achieves instantaneous disturbance estimation (reducing convergence time from 3 s to near zero), significantly smoother control inputs, and superior tracking accuracy with RMSE as low as 0.6788 m and MAE as low as 0.1468 m, reducing errors by up to 30.6% compared to baseline methods.