外部扰动下水下无人航行器鲁棒快速轨迹跟踪控制

Robust and fast trajectory tracking control of UUVs with external disturbances

  • 摘要:
    目的 针对外部扰动下水下无人航行器(UUV)的高性能轨迹跟踪控制问题,提出一种基于非线性扰动观测器(NDOB)的非奇异积分终端滑模控制(NITSMC)方法。
    方法 首先,建立包含集总扰动的UUV动力学方程。然后,设计NDOB对集总扰动进行观测,并基于扰动观测值设计NITSMC方法, 以有效补偿扰动,实现对期望轨迹的快速、高精度跟踪。通过与积分滑模控制(ISMC)和PID控制方法的对比仿真实验,验证所设计的NDOB-NITSMC控制方法的有效性和优越性。此外,以BlueROV2水下无人航行器为平台,进行水池试验,进一步验证该方法的有效性和实用性。
    结果 结果表明,NDOB-NITSMC方法可使UUV的位置姿态误差在8 s内收敛到0附近的小邻域内,4个自由度的位姿均方根误差分别为0.31,0.22,0.29 cm和0.23°,收敛速度和控制精度均优于ISMC和PID控制方法。在水池试验中,该方法可使UUV的位姿误差在15 s内收敛到0附近的小邻域内,4个自由度的位姿误差均方根误差分别为2.31,2.56,2.17 cm和1.11°,且控制输入较为平滑,适用于实际工程应用。
    结论 所提出的基于NDOB-NITSMC方法能够有效解决外部扰动下UUV的高性能轨迹跟踪控制问题,具有良好的工程应用前景。

     

    Abstract:
    Objective To address the high-performance trajectory tracking control problem for the unmanned underwater vehicle (UUV) under external disturbances, this paper proposes a non-singular integral terminal sliding mode control (NITSMC) scheme based on a nonlinear disturbance observer (NDOB).
    Methods First, the dynamic equation of UUV with lumped disturbances is established, and an NDOB is designed to estimate the lumped disturbances. On this basis, an NITSMC law is designed to effectively compensate for the disturbances, achieving fast and precise tracking of the desired trajectory. Finally, the effectiveness and superiority of the designed NDOB-NITSMC control scheme are validated through comparative simulations against the integral sliding mode control (ISMC) and PID control methods. Additionally, the effectiveness and practicality of NDOB-NITSMC are confirmed on the BlueROV2 UUV platform through water tank experiments.
    Results The results show that, in high-fidelity simulations, the NDOB-NITSMC scheme ensures that the position and orientation errors of BlueROV2 converge to a small neighborhood around zero within 8 seconds, with root mean squared errors (RMSEs) of 0.31, 0.22, 0.29 centimeters, and 0.23 degrees, respectively. The convergence speed and control accuracy surpass those of ISMC and PID control methods. In water tank experiments, the NDOB-NITSMC scheme ensures that the position and orientation errors of the UUV converge to a small neighborhood around zero within 15 seconds, with RMSEs of 2.31, 2.56, 2.17 centimeters, and 1.11 degrees, respectively. Additionally, the control inputs are smooth, ensuring its suitability for practical engineering applications.
    Conclusion The proposed NDOB-NITSMC scheme effectively addresses the high-performance trajectory tracking control problem for UUVs under external disturbances and demonstrates promising prospects for engineering applications.

     

/

返回文章
返回