针对欧拉角和单位四元数在求解大角度旋转机动时表现出的奇点和解绕局限问题,本文研究自主水下航行器(Autonomous Underwater Vehicle, AUV)在六自由度下的无模型跟踪控制方案。通过构建基于旋转矩阵的动力学模型,提出将姿态误差从SO(3)空间转换为欧几里得空间。并建立了分层回声状态网络(Hierarchical Echo State, ESN)来估计水动力系数和执行器故障,辅以协同批评网络(Cooperative Critic Network, CCN)增强学习能力。在保证高跟踪性能的同时,系统鲁棒性得到显著增强。基于旋转矩阵和分层ESN的控制方案有效克服传统姿态表示局限,适合自主水下航行器大角度转动。
To address the singularities and gimbal lock limitations of Euler angles and unit quaternions in solving large-angle rotational maneuvers, this paper investigates a model-free tracking control scheme for autonomous underwater vehicles in 6-DOF. By constructing a dynamics model based on rotation matrices, this study proposes converting attitude errors from SO(3) space to Euclidean space. A hierarchical echo state network (ESN) is established to estimate hydrodynamic coefficients and actuator faults, supplemented by a cooperative critic network (CCN) to enhance learning capability. While ensuring high tracking performance, the system′s robustness is significantly enhanced. The control scheme based on rotation matrices and hierarchical ESN effectively overcomes the limitations of traditional attitude representations, making it suitable for large-angle maneuvers of autonomous underwater vehicles.
2026,48(6): 150-158 收稿日期:2025-6-6
DOI:10.3404/j.issn.1672-7649.2026.06.020
分类号:U661.33
基金项目:国家自然科学基金资助项目(52471284,52101356);自然资源部资助项目(ZSTE-2025KB02);连云港市科研项目资助计划(LYG06521202337,LYG065212024049);江苏省教师培养项目;连云港市重点研发计划(CG2224);江苏科技大学与江苏省船舶与海洋工程装备技术创新中心联合基金资助项目(2025MTIC-JUST003)
作者简介:刘葳兴(1990-),女,博士,副教授,研究方向为水下无人航行器仿生推进
参考文献:
[1] 崔健, 赵林, 于金鹏, 等. 多AUV系统的自适应有限时间一致性跟踪控制[J]. 中国海洋大学学报(自然科学版), 2019, 49(S1): 170-176
CUI J, ZHAO L, YU J P, et al. Adaptive finite-time consensus tracking control for multi-AUV systems[J]. Journal of Ocean University of China (Natural Science Edition), 2019, 49(S1): 170-176
[2] 伊戈, 刘忠, 张建强, 等. 基于改进终端滑模控制的USV航向跟踪控制方法[J]. 电光与控制, 2020, 27(10): 12-16+21.
YI G, LIU Z, ZHANG J Q, et al. USV heading tracking control method based on improved terminal sliding mode control[J]. Electronics Optics & Control, 2020, 27(10): 12-16+21 .
[3] 李浩东. 基于深度强化学习的无人艇航迹控制的研究[D]. 镇江: 江苏科技大学, 2022.
[4] CHAVEZ G J, LI J, CHAUDHARY A, et al. ASV station keeping under wind disturbances using neural network simulation error minimization model predictive control[J]. Journal of Field Robotics, 2024, 41(6): 1797-1813.
[5] 包涛, 陈卓, 周则兴, 等. 基于改进无模型自适应控制算法的无人艇路径跟随控制[J/OL]. 控制理论与应用, 2025,42(9): 1849–1857.
BAO T, CHEN Z, ZHOU Z X, et al. Path following control of unmanned surface vehicle based on improved model-free adaptive control algorithm [J/OL]. Control Theory & Applications, 2025,42(9): 1849–1857.
[6] 余文曌, 陈晓东, 徐海祥. 基于事件触发的水下机器人无模型悬停控制[J]. 华中科技大学学报(自然科学版), 2023, 51(11): 30-37.
YU W Z, CHEN X D, XU H X. Model-free hovering control of underwater robots based on event-triggered mechanism[J]. Journal of Huazhong University of Science and Technology (Natural Science Edition), 2023, 51(11): 30-37.
[7] 杨德智, 徐海祥, 余文曌, 等. 执行器故障下多无人艇固定时间协同包围容错控制[J]. 大连海事大学学报, 2025, 51(1): 21-30.
YANG D Z, XU H X, YU W Z, et al. Fixed-time cooperative encirclement fault-tolerant control for multiple unmanned surface vehicles under actuator failures[J]. Journal of Dalian Maritime University, 2025, 51(1): 21-30.
[8] 王中, 温志文, 蔡卫军. 水下无人航行器编队协同搜索研究综述[J]. 舰船科学技术, 2024, 46(2): 57-62.
WANG Z, WEN Z W, CAI W J. A review of cooperative search studies for underwater unmanned vehicle formations[J]. Ship Science and Technology, 2024, 46(2): 57-62.
[9] 张恩华, 王巍凯, 苏玉民. 基于事件触发的水面无人艇无模型容错饱和控制[J]. 哈尔滨工程大学学报, 2024, 45(10): 1865-1872.
ZHANG E H, WANG W K, SU Y M. Model-free fault-tolerant saturated control for unmanned surface vehicles based on event-triggered mechanism[J]. Journal of Harbin Engineering University, 2024, 45(10): 1865-1872.
[10] TABATABAEE N F S, MOOSAVIAN S A A, KHALAJI A K. Adaptive fault-tolerant control for an autonomous underwater vehicle[J]. Robotica, 2022, 40(11): 4076-4089.
[11] 朱可嘉, 周子天, 王友清. 网络环境下无人艇定位系统的主动容错控制[J]. 控制工程, 2023, 30(6): 969-980.
ZHU K J, ZHOU Z T, WANG Y Q. Active fault-tolerant control of unmanned surface vehicle positioning systems in networked environments[J]. Control Engineering of China, 2023, 30(6): 969-980.
[12] LEE T. Exponential stability of an attitude tracking control system on SO(3) for large-angle rotational maneuvers[J]. Systems & Control Letters, 2012, 61(1): 231-237.
[13] ZHU C, JUN L, HUANG B, et al. Trajectory tracking control for autonomous underwater vehicle based on rotation matrix attitude representation[J]. Ocean Engineering, 2022, 252: 111206.
[14] ANTONELLI G. On the use of adaptive/integral actions for six-degrees-of-freedom control of autonomous underwater vehicles[J]. IEEE Journal of Oceanic Engineering, 2007, 32(2): 300–312.
[15] ZHU C, HUANG B, ZHOU B, et al. Adaptive model-parameter-free fault-tolerant trajectory tracking control for autonomous underwater vehicles[J]. ISA Transactions, 2021, 114: 57-71.
[16] LU Y, ZHANG G, SUN Z, et al. Adaptive cooperative formation control of autonomous surface vessels with uncertain dynamics and external disturbances[J]. Ocean Engineering, 2018, 167: 36-44.