海流扰动下无人水下航行器的动态面反演轨迹跟踪控制

doi:10.12305/j.issn.1001-506X.2021.06.25

摘要/Abstract

摘要：

针对存在未知海流扰动条件下无人水下航行器(unmanned underwater vehicle, UUV)的轨迹跟踪控制问题, 提出一种欠驱动UUV的动态面反演轨迹跟踪控制方法。首先, 设计一种改进型海流扰动观测器来估测航行器动力学模型中存在的未知海流扰动。然后, 采用反演法并结合动态面控制技术设计三维轨迹跟踪控制器, 将控制算法中微分运算转换为简单且易于实现的代数运算, 降低控制算法复杂性的同时避免“微分爆炸”问题, 结合李雅普诺夫理论证明系统闭环稳定性。最后, 对所设计的控制器进行仿真验证, 结果表明所设计观测器能够有效应对时变海流干扰问题, 精确地完成UUV的轨迹跟踪控制任务。

关键词: 无人水下航行器, 三维轨迹跟踪, 海流观测器, 动态面控制

Abstract:

Aiming at the trajectory tracking problem of unmanned underwater vehicle (UUV) with unknown ocean current disturbances, a dynamic surface backstepping trajectory tracking control strategy of underdrive UUV is proposed. Firstly, the novel ocean currents observer is designed to estimate the unknown ocean current disturbances of the dynamics equations. Then, the three dimensional trajectory tracking controllers are designed to combine backstepping method with dynamic surface control (DSC) technique, which can transform the differential operation in control algorithm into a simple algebraic operation, then reduce the complexity and avoid differential explosion of the control algorithm. Furthermore, the Lyapunov function is selected to prove the closed-loop stability of system. Finally, the designed controller is verified by simulation. The simulation results show that the proposed observer can effectively deal with time-varying ocean current disturbances, and accurately realize the trajectory tracking control of UUV.

Key words: unmanned underwater vehicle (UUV), three dimensional trajectory tracking, ocean currents observer, dynamic surface control (DSC)

中图分类号:

TP273

曹晓明, 魏勇, 衡辉, 沈智鹏. 海流扰动下无人水下航行器的动态面反演轨迹跟踪控制[J]. 系统工程与电子技术, 2021, 43(6): 1664-1672.

Xiaoming CAO, Yong WEI, Hui HENG, Zhipeng SHEN. Dynamic surface backstepping trajectory tracking control of unmanned underwater vehicles with ocean current disturbances[J]. Systems Engineering and Electronics, 2021, 43(6): 1664-1672.

图/表 10

图1

图2

图3

图4

图5

图6

图7

图8

图9

图10

参考文献 30

1	XU J , WANG M , QIAO L . Dynamical sliding mode control for the trajectory tracking of underactuated unmanned underwater vehicles[J]. Ocean Engineering, 2015, 105, 54- 63. doi: 10.1016/j.oceaneng.2015.06.022
2	BAK J , NGUYEN H N , PARK S , et al. Positioning control of an underwater robot with tilting thrusters via decomposition of thrust vector[J]. International Journal of Control Automation and Systems, 2017, 15 (1): 2283- 2291. doi: 10.1007/s12555-016-0298-x
3	ANGEl E Z S, ADRIAN M M, MIGUEL A G R, et al. Depth control of an underwater vehicle using robust pd controller: real-time experiments[C]//Proc. of the IEEE OES Autonomous Underwater Vehicle Workshop, 2018.
4	BORLAUG I , PETTERSEN K , GRAVDAHL J . Trajectory tracking for an articulated intervention AUV using a super-twisting algorithm in 6 DOF[J]. International Federation of Automatic Control, 2018, 51 (29): 311- 316.
5	ELMOKADEM T , ZRIBI M , YOUCEF T 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
6	WANG Y J , ZHANG M J , WILSON P A , et al. Adaptive neural network-based backstepping fault tolerant control for underwater vehicles with thruster fault[J]. Ocean Engineering, 2015, 110, 15- 24. doi: 10.1016/j.oceaneng.2015.09.035
7	张伟, 滕延斌, 魏世琳, 等. 欠驱动UUV自适应RBF神经网络反步跟踪控制[J]. 哈尔滨工程大学学报, 2018, 39 (1): 97- 103.
	ZHANG W , TENG Y B , WEI S L , et al. Underactuated UUV tracking control of adaptive RBF neural network and backstepping method[J]. Journal of Harbin Engineering University, 2018, 39 (1): 97- 103.
8	ZHANG W, XU D, TAN M L, et al. Trajectory tracking control of underactuated UUV for underwater recovery[C]//Proc. of the International Conference on Instrumentation and Measurement, 2013: 386-391.
9	SWAROOP D , HEDRICK J K , YIP P P , et al. Dynamic surface control for a class of nonlinear systems[J]. IEEE Trans.on Automatic Control, 2000, 45 (10): 1893- 1899. doi: 10.1109/TAC.2000.880994
10	张天平, 鲁瑶. 带有未建模动态的非线性系统的自适应动态面控制[J]. 控制与决策, 2012, 27 (3): 335- 342.
	ZHANG T P , LU Y . Adaptive dynamic surface control of nonlinear systems with unmodeled dynamics[J]. Control and Decision, 2012, 27 (3): 335- 342.
11	PAN Y P , YU H Y . Dynamic surface control via singular perturbation analysis[J]. Automatica, 2015, 57, 29- 33. doi: 10.1016/j.automatica.2015.03.033
12	CUI R X , YANG C G , LI Y , et al. Adaptive neural network control of AUVs with control input nonlinearities using reinforcement learning[J]. IEEE Trans.on Systems, Man, and Cybernetics, 2017, 47 (6): 1019- 1029. doi: 10.1109/TSMC.2016.2645699
13	GAN W Y, ZHU D Q, SUN B. Trajectory tracking of unmanned underwater vehicles based on model predictive control in two dimension[C]//Proc. of the Conference on Industrial Electronics and Applications, 2016: 212-217.
14	YAN Z P , YU H M , ZHANG W , et al. Globally finite-time stable tracking control of underactuated UUVs[J]. Ocean Engineering, 2015, 107, 132- 146. doi: 10.1016/j.oceaneng.2015.07.039
15	徐健, 汪慢, 乔磊. 欠驱动无人水下航行器三维轨迹跟踪的反步控制[J]. 控制理论与应用, 2014, 31 (11): 1589- 1596. doi: 10.7641/CTA.2014.30835
	XU J , WANG M , QIAO L . Backstepping-based controller for three-dimensional -trajectory tracking of underactuated unmanned underwater vehicles[J]. Control Theory and Applications, 2014, 31 (11): 1589- 1596. doi: 10.7641/CTA.2014.30835
16	YAN Z P , YANG Z W , ZHANG J Z , et al. Trajectory tracking control of UUV based on backstepping sliding mode with fuzzy switching gain in diving plane[J]. IEEE Access, 2019, 7, 166788- 166795. doi: 10.1109/ACCESS.2019.2953530
17	LI J , GUO H , ZHANG H H , et al. Double-loop structure integral sliding mode control for UUV trajectory tracking[J]. IEEE Access, 2019, 7, 101620- 101632. doi: 10.1109/ACCESS.2019.2925570
18	RANGEL M A G , MANZANILLA A , SUAREZ A E Z , et al. Adaptive non-singular terminal sliding mode control for an unmanned underwater vehicle: real-time experiments[J]. International Journal of Control, Automation and Systems, 2020, 18 (3): 615- 628. doi: 10.1007/s12555-019-0674-4
19	LIU S Y , LIU Y C , WANG N . Nonlinear disturbance observer-based backstepping finite-time sliding mode tracking control of underwater vehicles with system uncertainties and external disturbances[J]. Nonlinear Dynamics, 2016, 88 (1): 465- 476. doi: 10.1007%2Fs11071-016-3253-8
20	RASHAD R , ABOUDONIA A , EL-BADAWY A . A novel disturbance observer-based backstepping controller with command filtered compensation for a MIMO system[J]. Journal of the Franklin Institute, 2016, 353 (16): 4039- 4061. doi: 10.1016/j.jfranklin.2016.07.017
21	LIANG X , QU X R , HOU Y H , et al. Three-dimensional trajectory tracking control of an underactuated autonomous underwater vehicle based on ocean current observer[J]. International Journal of Advanced Robotic Systems, 2018, 15 (5): 1- 9.
22	MOBAYEN S . Adaptive global terminal sliding mode control scheme with improved dynamic surface for uncertain nonlinear systems[J]. International Journal of Control Automation and Systems, 2018, 16 (4): 1692- 1700. doi: 10.1007/s12555-017-0473-8
23	QIAO L , ZHANG W D . Double-loop integral terminal sliding mode tracking control for UUVs with adaptive dynamic compensation of uncertainties and disturbances[J]. IEEE Journal of Oceanic Engineering, 2019, 44 (1): 29- 53. doi: 10.1109/JOE.2017.2777638
24	DENNIS B , MOHAMED A M , CLAUDIO P , et al. Observer based path following for underactuated marine vessels in the presence of ocean currents: a global approach[J]. Automatica, 2019, 100, 123- 134. doi: 10.1016/j.automatica.2018.11.008
25	MOHAMED A M , DENNIS W J B , CLAUDIO P , et al. Observer based path following for underactuated marine vessels in the presence of ocean currents: a local approach[J]. International Federation of Automatic Control, 2017, 50 (1): 13654- 13661.
26	MOE S, CAHARIJA W, PETTERSEN K Y, et al. Path following of under actuated marine surface vessels in the presence of unknown ocean currents[C]//Proc. of the American Control Conference, 2014: 3856-3861.
27	LIANG X , QU X R , WANG N , et al. Three-dimensional trajectory tracking of an under-actuated AUV based on fuzzy dynamic surface control[J]. IET Intelligent Transport Systems, 2019, 14 (5): 364- 370.
28	SHI X Y , CHENG Y H , YIN C , et al. Design of adaptive backstepping dynamic surface control method with RBF neural network for uncertain nonlinear system[J]. Neurocomputing, 2019, 330, 490- 503. doi: 10.1016/j.neucom.2018.11.029
29	沈智鹏, 曹晓明. 基于扩张观测器的输入受限四旋翼飞行器轨迹跟踪动态面输出反馈控制[J]. 系统工程与电子技术, 2018, 40 (12): 2766- 2774. doi: 10.3969/j.issn.1001-506X.2018.12.21
	SHEN Z P , CAO X M . Extended state observer based dynamic surface output feedback control for quadrotor UAV trajectory tracking with input constraints[J]. Systems Engineering and Electronics, 2018, 40 (12): 2766- 2774. doi: 10.3969/j.issn.1001-506X.2018.12.21
30	YU H M , GUO C , YAN Z P . Globally finitetime stable three-dimensional trajectory-tracking control of under-actuated UUVs[J]. Ocean Engineering, 2019, 189, 106329. doi: 10.1016/j.oceaneng.2019.106329

[1]	徐海祥, 胡聪, 余文曌, 姚国全. 输入约束下的浮力调节式UUV变深控制[J]. 系统工程与电子技术, 2022, 44(11): 3496-3504.
[2]	卢晓东, 赵辉, 赵斌, 周军. 基于干扰补偿的拦截弹新型反演姿态控制[J]. 系统工程与电子技术, 2017, 39(5): 1100-1106.
[3]	雷虎民, 王华吉, 周觐, 张大元, 张旭. 基于扩张观测器的三维动态面导引律[J]. 系统工程与电子技术, 2017, 39(1): 138-146.
[4]	周成宝, 周荻. 面向摆动喷管的导弹非线性姿态控制[J]. 系统工程与电子技术, 2016, 38(5): 1107-.
[5]	李兵强, 陈晓雷, 林辉, 戴志勇. 飞机全电防滑刹车系统稳定动态面控制[J]. 系统工程与电子技术, 2016, 38(5): 1139-.
[6]	王晓芳，郑艺裕，林海. 导弹协同作战四维制导与控制一体化设计方法[J]. 系统工程与电子技术, 2015, 37(4): 874-881.
[7]	钱默抒，姜斌，许德智，陈复扬. 无人机姿控系统鲁棒动态面容错控制设计[J]. 系统工程与电子技术, 2014, 36(9): 1798-1803.
[8]	邓涛，姚宏，杜军，姜久龙. 高阶非线性时滞系统的神经网络动态面控制[J]. 系统工程与电子技术, 2014, 36(6): 1152-1161.
[9]	杜军1，邓涛1，姚宏2，彭兴钊1. 一类高阶非线性系统的动态面控制[J]. 系统工程与电子技术, 2014, 36(3): 546-552.
[10]	李良，谢建，黄建招. 起竖系统建模及动态面自适应滑模控制[J]. 系统工程与电子技术, 2014, 36(2): 337-342.
[11]	袁瑞侠, 刘金琨. 欠驱动VTOL飞行器的位置反馈动态面控制[J]. 系统工程与电子技术, 2014, 36(11): 2266-2271.
[12]	邓涛，姚宏，杜军. 高次非线性系统自适应动态面输出调节方法[J]. Journal of Systems Engineering and Electronics, 2013, 35(8): 1729-1735.
[13]	董文瀚，孙秀霞，林岩，尹晖. 航空发动机旋转失速和喘振的动态面控制[J]. Journal of Systems Engineering and Electronics, 2013, 35(7): 1502-1507.
[14]	陈盼，吴晓锋. UUV编队协同最优扩方应召搜索方法[J]. Journal of Systems Engineering and Electronics, 2013, 35(5): 987-992.
[15]	刘树光，孙秀霞，解武杰，董文瀚，刘放. 简化的鲁棒自适应动态面飞行控制律设计[J]. Journal of Systems Engineering and Electronics, 2013, 35(4): 820-825.