Robust Attitude Control of AUVs with Large Angle on SO(3)
摘要
A robust attitude feedback controller is proposed for large angle maneuvering attitude tracking problem of AUVs. In order to avoid Euler angle singularity and quaternion unwinding phenomenon, a special orthogonal group SO(3) is used to construct AUVs attitude equation. The attitude error function of SO(3) is constructed, and a kinematic error convergence equation is designed. Considering the uncertainty of AUVs model and the influence of ocean current disturbances, a nonlinear disturbance observer is designed, and the Lyapunov method is used to design the AUV dynamic feedback control law. The effectiveness of the proposed control algorithm is verified through numerical simulation. The results indicate that, under the influence of model uncertainty and external disturbances, the proposed controller can quickly converge the attitude of AUVs to the desired attitude.