为了解决AUV在空间运动中的路径点跟踪控制问题，参照水下航行器的建模方法，建立AUV的六自由度动力学和运动学模型，采用水平面视线导航法计算AUV指令航向，采用垂直面制导算法计算AUV的垂直面指令深度、指令纵倾和指令深度速率。针对AUV的水平面和垂直面控制，设计基于状态空间形式的模型预测控制算法。通过仿真表明，所提出的空间航迹控制算法能达到较高的控制精度，采用的指令深度+指令纵倾+指令深度速率的控制方法能使AUV尽快航行至指令轨迹并跟踪垂直面航迹。设计的空间路径点跟踪控制算法对AUV后续的控制系统开发具有一定的参考意义。
This study aims to solve the problem of the autonomous underwater vehicle’sway-point followingin three-dimensional motion. Firstly, the paper builds 6 degrees of freedom kinematics and kinetics model of the AUV according to the modeling method of UUV, thenusing the method of line-of-sight to calculate the command headingin horizontal plane, using guidance algorithm to calculate the command depth in vertical plane,finally the paper designs a modelpredictivecontrol algorithm based on the state-space model for horizontaland verticalcontrolof the AUV. By the result of the simulation, the proposed space track control algorithm can achieve high control accuracy. The control method which combines the command depth, command trim and command depth rate can make the AUV navigate to the command trajectory as soon as possible and track the vertical trajectory.The algorithm designed can be revelatory for the subsequent developing of the AUV’s control system.
2020,42(12): 86-91 收稿日期：2020-07-24
DOI：10.3404/j.issn.1672-7649.2020.12.017
分类号：U674.941
作者简介：张子昌(1995-),男,硕士,研究方向为潜艇操纵控制技术
参考文献：
[1] DO K D, JIANG Z P. Robust and adaptive path following for underactuated autonomous vehicles[J]. Ocean Engineering, 2004, 31(16): 1967-1997
[2] 王银涛, 郑美云, 严卫生. 一种新的AUV路径跟踪控制方法[J]. 西北工业大学学报, 2009, 27(4): 517-521
WANG Yintao, ZHENG Meiyun, YAN Weisheng. A new AUV path tracking control method[J]. Journal of Northwestern Polytechnical University, 2009, 27(4): 517-521
[3] SO-RYEOK Oh, JING Sun. Path following of underactuated marine surface vessels using line-of-sight based model predictive control[J]. Ocean Engineering, 2010, 37: 289-295
[4] 王宏健, 陈子印, 贾鹤鸣, 等. 基于滤波反步法的欠驱动AUV三维路径规划跟踪控制[J]. 自动化学报, 2015, 41(3): 631-645
WANG Hongjian, CHEN Zijian, JIA Heming, et al. Three-dimensional path-following control of underactuated autonomous underwater vehicle with command filtered backstepping[J]. ACTA Automatica Sinica, 2015, 41(3): 631-645
[5] 朱大奇, 张光磊, 李蓉. 生物启发AUV三维轨迹跟踪控制算法[J]. 智能系统学报, 2014(2): 58-63
[6] LI X, HOU S P, CHEAH C C. Adaptive region tracking control for autonomous underwater vehicle[C]. IEEE International Conference on Control, Robotics and Vision, 2010.
[7] ISMAIL Z H, DUNNIGAN M W. A region boundary-based control scheme for an autonomous underwater vehicle[J]. Ocean Engineering, 2011, 38(11): 2270-2280
[8] 张铭钧, 褚振忠. 自主式水下机器人自适应区域跟踪控制[J]. 机械工程学报, 2014, 50(2019): 50-57
ZHANG Mingjun, CHU Zhenzhong. Adaptive region tracking control for autonomous underwater vehicle[J]. Journal of Mechanical Engineering, 2014, 50(2019): 50-57
[9] 程相勤. 基于滑模理论的欠驱动UUV空间曲线路径跟踪控制[D]. 哈尔滨: 哈尔滨工程大学, 2010: 78−79.
CHENG X Q. Spatial curvilinear path following of underactuated UUV based on sliding mode theory [D]. Harbin: Harbin Engineering University, 2010: 78−79.
[10] T. I. Fossen, Guidance and Control of Ocean Vehicles[M]. Chicester: John Wiley & Sons, 1994.
[11] 边信黔, 付明玉, 王元慧. 船舶动力定位[M]. 北京: 科学出版社, 2011.
[12] 龚建伟, 姜岩, 徐威. 无人驾驶车辆模型预测控制[M]. 北京: 北京理工大学出版社, 2014.
[13] 邹涛, 丁宝仓, 张端. 模型预测控制工程应用导论[M]. 北京: 化学工业出版社, 2010.
