Model free adaptive path following control based on active disturbance rejection theory for AUV
-
摘要: 面向自主水下航行器(AUV)精准回收的任务需求, 针对AUV运动中模型不确定性、易受环境干扰导致的路径跟踪精度不足的问题, 从无模型控制的角度出发, 提出了一种适用于AUV的基于自抗扰理论的无模型自适应控制(ADRC-MFAC)算法。该算法针对2阶系统模型特性, 结合视线角制导重新设计控制输入准则函数对无模型自适应控制(MFAC)进行了改进, 解决了MFAC只适用于自衡系统的问题。引入跟踪微分器对期望信号进行指令平滑, 考虑未知复合干扰的影响设计了线性扩张状态观测器, 并在控制器中对估计扰动进行补偿, 并证明了所提控制器的稳定性, 提升了系统鲁棒性。在同样的干扰情况下, 文中控制方案相比传统比例-积分-微分控制器(PID)抗干扰能力提升了42.37%, 控制精度提高了45%, 表明ADRC-MFAC能够明显改善AUV的抗干扰性能, 提高路径跟踪精度。Abstract: Aiming at the task requirements of accurate recovery of autonomous underwater vehicles (AUVs), a model-free adaptive path tracking control based on active disturbance rejection theory (ADRC-MFAC) is proposed from the perspective of modelless control in view of the insufficient path tracking accuracy caused by model uncertainty and vulnerability to environmental interference in AUV motion. According to the characteristics of second-order model system and line-of-sight guidance, the algorithm redesigned the control input criterion function to improve model free adaptive control(IMFAC),solved the problem that MFAC is applicable to self-balancing system. Introduced tracking dif-ferentiator to smooth the desired signal and designed linear extended state observer considering the influence of unknown compound interference, compensated the estimated disturbance in the controller, improved the stability of the control system and improved robustness. With the same of disturbance, the proposed control scheme can improve 42.37% of robustness and 45% of accuracy with PID. The result shows that ADRC-MFAC can significantly improve the anti-interference performance of AUV, and improve the path tracking accuracy.
-
表 1 AUV模型参数列表
Table 1. Model Parameters of AUV
名称 参数 名称 参数 m/kg 30.48 $ {I_z} $/(kg m2) 3.45 $ {X_u} $/(Ns/m) −13.5 $ {N_{\dot r}} $/(kg m2/rad) −4.88 $ {Y_v} $/(Ns/m) −66.6 $ {X_{u|u|}} $/(Ns2/m2) −1.62 $ {N_r} $/(Ns/rad) −5.98 $ {Y_{v|v|}} $/(Ns2/m2) −131 $ {X_{\dot u}} $/kg −0.93 $ {N_{r|r|}} $/(Ns2/rad2) −94 $ {Y_{\dot v}} $/kg −35.5 — — 表 2 多航点路径跟踪性能指标
Table 2. Performance index of multiple waypoints path following
指标 PID IMFAC ADRC-MFAC 航向超调量/(°) 4.58 10.47 0.61 航向调节时间/s 11.96 22.08 2.51 航向稳态误差/(°) 0 0.07 0 偏距平均误差/m 0.350 0.420 0.32 偏距稳态误差/m 0.001 0.001 0 表 3 圆路径跟踪性能指标
Table 3. Performance index of circle path following
指标 PID IMFAC ADRC-MFAC 航向超调量/(°) 20.13 27.87 11.62 航向调节时间/s 44.63 43.87 30.69 航向稳态误差/(°) 3.11 3.21 1.71 偏距平均误差/m 0.42 0.47 0.35 偏距稳态误差/m 0.17 0.23 0.13 -
[1] Neira J, Sequeiros C, Huamani R, et al. Review on unmanned underwater robotics, structure designs, materials, sensors, actuators, and navigation control[J]. Journal of Robotics, 2021, 18(6): 1-26. [2] 宋保维, 潘光, 张立川, 等. 自主水下航行器发展趋势及关键技术[J]. 中国舰船研究, 2022, 17(5): 27-44.Song Baowei, Pan Guang, Zhang Lichuan, et al. Development trend and key technologies of autonomous underwater vehicles[J]. Chinese Journal of Ship Research, 2022, 17(5): 27-44. [3] Cao X, Sun H, Guo L. Potential field hierarchical reinforcement learning approach for target search by multi-AUV in 3D underwater environments[J]. International Journal of Control, 2022(7a9): 1677-1683. [4] 李锦江. 海洋无人航行器预设性能运动控制技术研究 [D]. 武汉: 华中科技大学, 2022. [5] Yu C, Xiang X, Dai J. 3D path following for under-actuated AUV via nonlinear fuzzy controller[C]//Oceans 2016. Shanghai: IEEE, 2016. [6] Elmokadem T, Zribi M, Youcef-Toumi K. Terminal sliding mode control for the trajectory tracking of underactuated autonomous underwater vehicles[J]. Ocean Engineering, 2017, 129: 613-625. doi: 10.1016/j.oceaneng.2016.10.032 [7] Wang Z, Guan X, Liu C, et al. Acoustic communication and imaging sonar guided AUV docking: system infrastructure, docking methodology and lake trials[J]. Control Engineering Practice, 2023(136): 105-129. [8] 田涛涛, 侯忠生, 刘世达, 等. 基于无模型自适应控制的无人驾驶汽车横向控制方法[J]. 自动化学报, 2017, 43(11): 1931-1940.Tian Taotao, Hou Zhongsheng, Liu Shida, et al. Model free adaptive control based lateral control of selfdriving car[J]. Acta Automatica Sinica, 2017, 43(11): 1931-1940. [9] 高鹏, 万磊, 徐钰斐, 等. 基于无模型自适应控制的底栖式AUV 路径点跟踪控制[J]. 水下无人系统学报, 2022, 30(4): 429-440. doi: 10.11993/j.issn.2096-3920.202109021Gao P, Wan L, Xu Y, et al. Waypoint-tracking control of a benthic AUV based on model-free adaptive control method[J]. Journal of Unmanned Undersea Systems, 2022, 30(4): 429-440. doi: 10.11993/j.issn.2096-3920.202109021 [10] Li X, Ren C, Ma S, et al. Compensated model-free adaptive tracking control scheme for autonomous underwater vehicles via extended state observer[J]. Ocean Engineering, 2020, 217(9): 107-217. [11] Fossen T I. Line-of-sight path-following control utilizing an extended Kalman filter for estimation of speed and course over ground from GNSS positions[J]. Journal of Marine Science and Technology, 2022, 27: 806-813. doi: 10.1007/s00773-022-00872-y [12] 侯忠生, 金尚泰. 无模型自适应控制[M]. 北京: 科学出版社, 2013. [13] 韩京清. 自抗扰控制技术[J]. 前沿科学, 2007(1): 24-31. doi: 10.3969/j.issn.1673-8128.2007.01.004Han Jingqing. Active disturbances rejection control technique[J]. Frontier Science, 2007(1): 24-31. doi: 10.3969/j.issn.1673-8128.2007.01.004 [14] Fossen T I. Handbook of marine craft hydrodynamics and motion control[M]. UK: John Wiley & Sons Inc, 2011.