基于滤波反步法的欠驱动AUV三维路径跟踪控制

王宏健; 陈子印; 贾鹤鸣; 李娟; 陈兴华

doi:10.16383/j.aas.2015.c130883

基于滤波反步法的欠驱动AUV三维路径跟踪控制

doi: 10.16383/j.aas.2015.c130883

1.
哈尔滨工程大学自动化学院哈尔滨 150001;
2.
北京空间机电研究所北京 100094;
3.
东北林业大学机电工程学院哈尔滨 150040

基金项目:

国家自然科学基金(E091002/50979017), 教育部高等学校博士学科点专项科研基金(20092304110008), 中央高校基本科研业务费专项资金(HEUCFZ1026), 哈尔滨市科技创新人才(优秀学科带头人)研究专项资金(2012RFXXG083)资助

详细信息

作者简介:
陈子印北京空间机电研究所工程师.2013年获得哈尔滨工程大学模式识别与智能系统专业博士学位.主要研究方向为非线性控制系统, 稳像控制, 视觉伺服控制, 并联机械系统. E-mail: chenziyin_heu@163.com

通讯作者:
王宏健哈尔滨工程大学自动化学院教授.主要研究方向为智能控制, 智能优化方法与技术.本文通信作者. E-mail: cctime99@163.com

计量
- 文章访问数: 2688
- HTML全文浏览量: 147
- PDF下载量: 1489
- 被引次数: 0
出版历程
- 收稿日期: 2013-09-22
- 修回日期: 2014-09-27
- 刊出日期: 2015-03-20

Three-dimensional Path-following Control of Underactuated Autonomous Underwater Vehicle with Command Filtered Backstepping

1.
College of Automation, Harbin Engineering University, Harbin 150001;
2.
Beijing Institute of Space Mechanics and Electricity, Beijing 100094;
3.
College of Mechanical and Electrical Engineering, Northeast Forestry University, Harbin 150040

Funds:

Supported by National Natural Science Foundation of China (E091002/50979017), Specialized Research Fund for the Doctoral Program of Higher Education of China (20092304110008), Fundamental Research Funds for the Central Universities (HEU CFZ1026), and Harbin Science and Technology Innovation Talents of Special Fund Project (Outstanding Subject Leaders) (2012RFXXG083)

摘要

摘要: 研究了欠驱动自主水下航行器 (Autonomous underwater vehicle, AUV)的三维空间路径跟踪控制问题.针对基于虚拟向导建立的三维路径跟踪误差模型, 采用滤波反步法设计跟踪控制器,通过二阶滤波过程获得虚拟控制量的导数, 避免了直接对虚拟控制量解析求导的复杂过程, 同时滤除了高频测量噪声, 增加了系统对噪声的鲁棒性.通过设计滤波误差补偿回路, 保证了滤波信号对虚拟控制量的逼近精度.基于李雅普诺夫稳定性理论设计鲁棒项, 保证了闭环跟踪误差系统状态的渐近稳定.仿真结果表明了该控制器对噪声干扰具有一定的鲁棒性, 能够实现对三维路径的精确跟踪.
- 欠驱动自主水下航行器 /
- 三维路径跟踪 /
- 滤波反步法 /
- 虚拟向导
Abstract: This paper studies the path-following control problem for an autonomous underwater vehicle (AUV) in the three-dimensional space. With the three-dimensional path-following error model established based on the virtual guidance law, a path-following controller is designed using the command filtered backstepping method. The derivative of virtual control can be obtained by a second-order filter, which avoids the complexity to compute the analytic derivative of the virtual control, and filters out high frequency measurement noise to keep the control system more robust. A filtering error compensation loop is designed to guarantee the approximation precision between the filtered signal and the command virtual control. The robust terms are designed through Lyapunov stability theorem, then the closed-loop of path-following error system is proved asympotic stability. Finally, simulation results illustrate the good robustness of the proposed controller under noise disturbances, and accurate tracking ability in the three-dimensional space.
- Underactuated autonomous underwater vehicle (AUV) /
- three-dimensional path-following /
- command filtered backstepping /
- virtual guidance

HTML全文

参考文献(36)

[1]	Xiang Xian-Bo. Research on Path Following and Coordinated Control for Second-order Nonholonomic UUVs [Ph.D. dissertation], Huazhong University of Science and Technology, China, 2010.(向先波. 二阶非完整性水下机器人的路径跟踪与协调控制研究 [博士学位论文], 华中科技大学, 中国, 2010.)
[2]	Wang Fang, Wan Lei, Li Ye, Su Yu-Min, Xu Yu-Ru. A survey on development of motion control for underactuated AUV. Shipbuilding of China, 2010, 51(2): 227-241(王芳, 万磊, 李晔, 苏玉民, 徐玉如. 欠驱动AUV的运动控制技术综述. 中国造船, 2010, 51(2): 227-241)
[3]	Zhang Li-Jun, Jia He-Ming, Bian Xin-Qian, Yan Zhe-Ping, Cheng Xiang-Qin. Three-dimensional path tracking control for an autonomous underwater vehicle based on L2 disturbance attenuation method. Control Theory and Applications, 2011, 28(5): 645-651(张利军, 贾鹤鸣, 边信黔, 严浙平, 程相勤. 基于L2干扰抑制的水下机器人三维航迹跟踪控制. 控制理论与应用, 2011, 28(5): 645-651)
[4]	Jia He-Ming, Zhang Li-Jun, Qi Xue, Yang Li-Xin. Three-dimensional path tracking control for autonomous underwater vehicle based on neural network. Control Theory and Applications, 2012, 29(7): 877-883(贾鹤鸣, 张利军, 齐雪, 杨立新. 基于神经网络的水下机器人三维航迹跟踪控制. 控制理论与应用, 2012, 29(7): 877-883)
[5]	Jia He-Ming, Cheng Xiang-Qin, Zhang Li-Jun, Bian Xin-Qian, Yan Zhe-Ping. Three-dimensional path tracking control for underactuated AUV based on adaptive Backstepping. Control and Decision, 2012, 27(5): 652-657(贾鹤鸣, 程相勤, 张利军, 边信黔, 严浙平. 基于自适应Backstepping的欠驱动AUV三维航迹跟踪控制. 控制与决策, 2012, 27(5): 652-657)
[6]	Shi Shu-Wei, Yan Wei-Sheng, Gao Jian, Li Wen-Bai. Path-following control of an AUV in the horizontal plane with constant ocean currents. Acta Armamentarii, 2010, 31(3): 375-379(施淑伟, 严卫生, 高剑, 李闻白. 常值海流作用下的AUV水平面路径跟踪控制. 兵工学报, 2010, 31(3): 375-379)
[7]	[7] Lapierre L, Soetanto D. Nonlinear path-following control of an AUV. Ocean Engineering, 2007, 34(11): 1734-1744
[8]	[8] Lapierre L, Jouvencel B. Robust nonlinear path-following control of an AUV. IEEE Journal of Oceanic Engineering, 2008, 33(2): 89-102
[9]	Bian Xin-Qian, Cheng Xiang-Qin, Jia He-Ming, Yan Zhe-Ping, Zhang Li-Jun. A bottom-following controller for underactuated AUV based on iterative sliding and increment feedback. Control and Decision, 2011, 26(2): 289-292(边信黔, 程相勤, 贾鹤鸣, 严浙平, 张利军. 基于迭代滑模增量反馈的欠驱动AUV地形跟踪控制. 控制与决策, 2011, 26(2): 289- 292)
[10]	Wang H J, Chen Z Y, Jia H M, Chen X H. NN-backstepping for diving control of an underactuated AUV. In: Proceedings of the 2011 MTS/IEEE Kona Conference OCEANS'11. Waikoloa, HI: IEEE, 2011. 1-6
[11]	Li J H, Lee P M. Path tracking in dive plane for a class of Torpedo-type underactuated UUVs. In: Proceedings of the 7th Asian Control Conference. Hong Kong, China: IEEE, 2009. 360-365
[12]	Wang Hong-Jian, Chen Zi-Yin, Bian Xin-Qian, Jia He-Ming, Li Juan. Three-dimensional straight line path-tracking control for underactuated underwater vehicle. Control Theory and Applications, 2013, 30(4): 443-453(王宏健, 陈子印, 边信黔, 贾鹤鸣, 李娟. 欠驱动水下航行器三维直线航迹跟踪控制. 控制理论与应用, 2013, 30(4): 443-453)
[13]	Do K D, Pan J, Jiang Z P. Robust and adaptive path following for underactuated autonomous underwater vehicls. Ocean Engineering, 2004, 31(16): 1967 -1997
[14]	Aguiar A P, Hespanha J P. Trajectory-tracking and path-following of underactuated autonomous vehicles with parametric modeling uncertainty. IEEE Transactions on Automatic Control, 2007, 52(8): 1362-1379
[15]	Encarnacao P, Pascoal A. 3D path following for autonomous underwater vehicle. In: Proceedings of the 39th IEEE Conference on Decision and Control. Sydney, NSW: IEEE, 2000. 2978-2982
[16]	Borhaug E, Pettersen K Y. Cross-track control for underactuated autonomous vehicles. In: Proceedings of the 44th IEEE Conference on Decision and Control. Spain: IEEE, 2005. 602-608
[17]	Ge Hui, Jing Zhong-Liang, Gao Jian. Neural network H robust adaptive control for autonomous underwater vehicle in 3-dimensional path following. Control Theory and Applications, 2012, 29(3): 317-322(葛晖, 敬忠良, 高剑. 自主式水下航行器三维路径跟踪的神经网络H_鲁棒自适应控制方法. 控制理论与应用, 2012, 29(3): 317- 322)
[18]	Jia He-Ming, Zhang Li-Jun, Cheng Xiang-Qin, Bian Xin-Qian, Yan Zhe-Ping. Three-dimensional path tracking control for an underactuated AUV based on discrete-time sliding mode prediction. Control and Decision, 2011, 26(10): 1452-1458(贾鹤鸣, 张利军, 程相勤, 边信黔, 严浙平. 基于离散滑模预测的欠驱动AUV三维航迹跟踪控制. 控制与决策, 2011, 26(10): 1452- 1458)
[19]	Jia He-Ming, Zhang Li-Jun, Cheng Xiang-Qin, Bian Xin-Qian, Yan Zhe-Ping, Zhou Jia-Jia. Three-dimensional path following control for an underactuated UUV based on nonlinear iterative sliding mode. Acta Automatica Sinica, 2012, 38(2): 308-313(贾鹤鸣, 张利军, 程相勤, 边信黔, 严浙平, 周佳加. 基于非线性迭代滑模的欠驱动UUV三维航迹跟踪控制. 自动化学报, 2012, 38(2): 308-313)
[20]	Yang Jun-Hua, Wu Jie, Hu Yue-Ming. Backstepping method and its applications to nonlinear robust control. Control and Decision, 2002, 17(S1): 641-653(杨俊华, 吴捷, 胡跃明. 反步方法原理及在非线性鲁棒控制中的应用. 控制与决策, 2002, 17(S1): 641-653)
[21]	Wang Hong-Jian, Chen Zi-Yin, Jia He-Ming, Li Juan. Backstepping method with PID gain tuning in diving control of autonomous underwater vehicle. Control Theory and Applications, 2012, 29(9): 1139-1145(王宏健, 陈子印, 贾鹤鸣, 李娟. 具有PID反馈增益的自主水下航行器反步法变深控制. 控制理论与应用, 2012, 29(9): 1139- 1145)
[22]	Stotsky A, Hedrick J K, Yip P P. The use of sliding modes to simplify the backstepping control method. In: Proceedings of the 1997 American Control Conference. Albuquerque, NM: IEEE, 1997. 1703-1708
[23]	Yip P P, Hedrick J K, Swaroop D. The use of linear filtering of simplified integrator backstepping control of nonlinear systems. In: Proceedings of the 1996 IEEE Workshop on Variable Structure System. Tokyo: IEEE, 1996. 211-215
[24]	Yip P C P. Robust and Adaptive Nonlinear Control Using Dynamic Surface Controller with Applications to Intelligent Vehicle Highway Systems [Ph.D. dissertation], University of California, Berkeley, 1997. 70-90
[25]	Dong W J, Farrell J A, Polycarpou M M, Sharma M. Command filtered adaptive backstepping. IEEE Transactions on Control Systems Technology, 2011, 20(3): 566-580
[26]	Farrell J A, Polycarpou M, Sharma M, Dong W J. Command filtered backstepping. IEEE Transactions on Automatic Control, 2005, 54(6): 1391-1395
[27]	Zhou Hong-Bo, Pei Hai-Long, He Yue-Bang, Sun Tai-Ren. Trajectory-tracking control for small unmanned helicopter with state constraints. Control Theory and Applications, 2012, 29(6): 778-784(周洪波, 裴海龙, 贺跃帮, 孙太任. 状态受限的小型无人直升机轨迹跟踪控制. 控制理论与应用, 2012, 29(6): 778-784)
[28]	Zhou Hong-Bo, Pei Hai-Long, He Yue-Bang, Zhao Yun-Ji. Trajectory tracking control of unmanned helicopter via filtering backstepping. Control and Decision, 2012, 27(4): 613 -617(周洪波, 裴海龙, 贺跃帮, 赵运基. 基于滤波反步法的无人直升机轨迹跟踪控制. 控制与决策, 2012, 27(4): 613-617)
[29]	Lv Y Y, Hu Q L, Ma G F, Zhou J K. 6 DOF synchronized control for spacecraft formation flying with input constraint and parameter uncertainties. ISA Transactions, 2011, 50(4): 573-580
[30]	Zhang F, Duan G R. Integrated translational and rotational control for the terminal landing phase of a lunar module. Aerospace Science and Technology, 2013, 27(1): 112-126
[31]	Fossen T I. Marine Control Systems: Guidance, Navigation and Control of Ships, Rigs and Underwater Vehicles. Trondheim: Marine Cybernetices, 2002. 88-114
[32]	Reyhanoglu M, van der Schaf A, McClamroch N H, Kolmanovsky I. Dynamics and control of a class of underactuated mechanical systems. IEEE Transactions on Automatic Control, 1999, 44(9): 1663-1672
[33]	Breivik M, Fossen T I. Guidance-based path following for autonomous underwater vehicles. In: Proceedings of the 2005 MTS/IEEE. Seville, Spain: IEEE, 2005. 2807-2814
[34]	Breivik M, Fossen T I. Principles of guidance-based path following in 2D and 3D. In: Proceedings of the 44th IEEE Conference on Decision and Control. Seville, Spain: IEEE, 2005. 627-634
[35]	Bang H, Tahk M J, Choi H D. Large angle attitude control of spacecraft with actuator saturation. Control Engineering Practice, 2003, 11(9): 989-997
[36]	Khalil H K. Nonlinear System (3rd edition). Englewood Cliffs, NJ: Prentice Hall, 2002.

施引文献

资源附件(0)

访问统计

计量

文章访问数: 2688
HTML全文浏览量: 147
PDF下载量: 1489
被引次数: 0

姓名
邮箱
手机号码
标题
留言内容
验证码

留言板

基于滤波反步法的欠驱动AUV三维路径跟踪控制

doi: 10.16383/j.aas.2015.c130883

作者简介:
陈子印北京空间机电研究所工程师.2013年获得哈尔滨工程大学模式识别与智能系统专业博士学位.主要研究方向为非线性控制系统, 稳像控制, 视觉伺服控制, 并联机械系统. E-mail: chenziyin_heu@163.com

通讯作者:
王宏健哈尔滨工程大学自动化学院教授.主要研究方向为智能控制, 智能优化方法与技术.本文通信作者. E-mail: cctime99@163.com

计量

Three-dimensional Path-following Control of Underactuated Autonomous Underwater Vehicle with Command Filtered Backstepping

计量

目录

留言板

基于滤波反步法的欠驱动AUV三维路径跟踪控制

doi: 10.16383/j.aas.2015.c130883

作者简介: 陈子印 北京空间机电研究所工程师.2013年获得哈尔滨工程大学模式识别与智能系统专业博士学位.主要研究方向为非线性控制系统, 稳像控制, 视觉伺服控制, 并联机械系统. E-mail: chenziyin_heu@163.com

通讯作者: 王宏健 哈尔滨工程大学自动化学院教授.主要研究方向为智能控制, 智能优化方法与技术.本文通信作者. E-mail: cctime99@163.com

计量

出版历程

Three-dimensional Path-following Control of Underactuated Autonomous Underwater Vehicle with Command Filtered Backstepping

计量

出版历程

目录

作者简介:
陈子印北京空间机电研究所工程师.2013年获得哈尔滨工程大学模式识别与智能系统专业博士学位.主要研究方向为非线性控制系统, 稳像控制, 视觉伺服控制, 并联机械系统. E-mail: chenziyin_heu@163.com

通讯作者:
王宏健哈尔滨工程大学自动化学院教授.主要研究方向为智能控制, 智能优化方法与技术.本文通信作者. E-mail: cctime99@163.com