针对X舵AUV的零纵倾变深控制问题,提出一种基于非线性干扰观测器的滑模控制方法。该方法首先在AUV垂直面操纵模型的基础上,分别对深度与纵倾通道设计非线性干扰观测器,观测AUV变深时深度与纵倾双通道的耦合干扰以及未建模动态,并对其进行前馈补偿;其次,设计深度与纵倾双通道耦合控制器,通过同时对深度与纵倾进行控制减小变深过程的纵倾变化,实现AUV的零纵倾变深控制;最后,设计X舵的舵角分配算法,实现十字舵向X舵的舵角指令转化。仿真结果表明,本文提出的零纵倾变深控制算法能够有效地控制AUV完成高精度零纵倾变深航行。
To solve the zero-pitch depth control of X-rudder AUV, a sliding mode control method based on nonlinear disturbance observer was proposed. Firstly, based on the vertical plane model of AUV, nonlinear disturbance observer was designed for depth and pitch channels respectively, and the coupling disturbance and unmodeled dynamics was observed, and feedforward compensation was carried out for them. Secondly, a dual-channel coupling controller of depth and pitch was designed to control the depth and pitch at the same time, to realize the zero-pitch depth control of AUV. Finally, the X-rudder angle allocation algorithm was designed to realize the instruction transformation from cross rudder to X-rudder. Simulation results show that the proposed zero-pitch depth control algorithm can make the AUV to complete the high precision zero-pitch depth control effectively.
2022,44(18): 73-77 收稿日期:2021-11-26
DOI:10.3404/j.issn.1672-7649.2022.18.016
分类号:U664.82
作者简介:李杨(1987-),男,博士,工程师,研究方向为船舶导航与操纵控制技术
参考文献:
[1] 黄琰, 李岩, 俞建成, 等. AUV智能化现状与发展趋势[J]. 机器人, 2020, 42(2): 215–231
HUANG Yan, LI Yan, YU Jian-cheng, et al. State of the art and development trends of AUV intelligence[J]. Robot, 2020, 42(2): 215–231
[2] 王小平. X舵AUV控制分配优化与容错控制方法研究[D]. 哈尔滨: 哈尔滨工程大学, 2020.
[3] 李岳明, 王小平, 张军军, 等. 基于改进二次规划算法的X舵智能水下机器人控制分配[J]. 上海交通大学学报, 2020, 54(5): 524–531
LI Yue-ming, WANG Xiao-ping, ZHANG Jun-jun, et al. X-rudder AUV control allocation based on improved quadratic programming algorithm[J]. Journal of Shanghai Jiao Tong University, 2020, 54(5): 524–531
[4] 杨德成, 郭亦平, 任元洲, 等. 多约束模型预测控制在AUV深度控制中的应用[J]. 舰船科学技术, 2021, 43(3): 120–124
YANG De-cheng, GUO Yi-ping, REN Yuan-zhou, et al. Application research of multi-constrained model predictive control in AUV depth control[J]. Ship Science and Technology, 2021, 43(3): 120–124
[5] 霍江航, 姜向远, 栾义忠, 等. 基于L1自适应理论的AUV深度控制器设计[J]. 中国舰船研究, 2021, 16(5): 150–157
HUO Jiang-hang, JIANG Xian-gyuan, LUAN Yi-zhong, et al. Design of AUV depth controller based on L1 adaptive theory[J]. Chinese Journal of Ship Research, 2021, 16(5): 150–157
[6] 绕志荣, 董绍江, 王军, 等. 基于干扰观测器的AUV深度自适应终端滑模控制[J]. 北京化工大学学报(自然科学版), 2021, 48(1): 103–107
RAO Zhi-rong, DONG Shao-jiang, WANG Jun, et al. Adaptive terminal sliding mode control of AUV depth based on a disturbance observer[J]. Journal of Beijing University of Chemical Technology(Natural Science), 2021, 48(1): 103–107
[7] FOSSEN T. I. Guidance and control of ocean vehicles[M]. Chicester: John Wiley & Sons, 1994.
[8] WANG Wen-jin, XIA Ying-kai, CHEN Ying, et al. motion control methods for x-rudder underwater vehicles: model based sliding mode and non-model based iterative sliding mode. [J] Ocean Engineering, 2020, 216: 1–16.
[9] PRESTERO T. Verification of a six-degree of freedom simulation model for the REMUS autonomous underwater vehicle[D]. Woods Hole Ocenographic Institution, Departments of Ocean and Mechanical Engineering, MIT, MA, 2001.