Design and Implementation of a Path Tracking System for Fully Actuated AUV
-
摘要: 针对全驱动自主水下航行器(AUV)水下搜救和回收等应用需求, 提出一种基于全球定位系统(GPS)、多普勒计程仪(DVL)、光纤惯导和深度计及航路点跟踪的AUV路径跟踪控制系统。结合自主研发的“探海Ι型”AUV样机, 介绍了AUV分布式系统组成结构、基于MOOS库的软件开发设计以及基于PC104总线架构开发的硬件设计, 并针对AUV系统的路径跟踪功能, 阐述了航路点跟踪原理及以GPS、DVL、光纤惯导和深度计为基础的导航算法, 并设计了比例-积分-微分(PID)路径跟踪控制器, 最后进行了路径跟踪湖试, 经过对试验曲线的分析, 验证了该方法的有效性, 为今后进一步优化路径跟踪探明了一条可行的技术途径。
-
关键词:
- 自主水下航行器 /
- 路径跟踪 /
- 比例-积分-微分控制器 /
- 航路点跟踪
Abstract: Aiming at the application requirements for such as recovery, underwater search and rescue, and so on, a path tracking control system for fully actuated autonomous undersea vehicle(AUV) is proposed based on global positioning system(GPS), Doppler velocity log(DVL), optical fiber inertial navigation, depth gauge and waypoint tracking. The distributed system structure of AUV, the software design based on MOOS, the hardware design based on PC104 bus architecture are introduced according to the independently developed T-Sea I type AUV prototype. The principle of waypoint tracking and the navigation algorithm based on GPS, DVL, optical fiber inertial navigation and depth gauge are discussed, and then a proportion-integral-derivative(PID) path tracking controller is designed. Lake test of path tracking is carried out and the test curves are analyzed to verify the validity of the proposed method. -
[1] 王芳, 万磊, 李晔, 等. 欠驱动AUV的运动控制技术综述[J]. 中国造船, 2010, 51(2): 227-241.Wang Fang, Wan Lei, Li Ye, et al. A Survey on Development of Motion Control for Underactuated AUV[J]. Shipbuilding of China, 2010, 51(2): 227-241. [2] 钟宏伟. 国外无人水下航行器装备与技术现状及展望[J]. 水下无人系统学报, 2017, 25(4): 215-225.Zhong Hong-wei. Review and Prospect of Equipment and Techniques for Unmanned Undersea Vehicle in Foreign Countries[J]. Journal of Unmanned Undersea Systems, 2017, 25(4): 215-225. [3] 赵朝闻, 张淞, 李辉. 基于超短基线的AUV自主对接流程及算法[J]. 鱼雷技术, 2016, 24(3): 166-171.Zhao Chao-wen, Zhang Song, Li Hui. Autonomous Abutting Joint Flow and Control Algorithm for AUV Based on Ultra-short Baseline[J]. Torpedo Technology, 2016, 24(3): 166-171. [4] Lapierre L, Soetanto D. Nonlinear Path-following Control of an AUV[J]. Ocean Engineering, 2007, 34(11): 1734- 1744. [5] Lapierre L, Jouvencel B. Robust Nonlinear Path-following Control of an AUV[J]. IEEE Journal of Oceanic Engineering, 2008, 33(2): 89-102. [6] Oh S R, Sun J. Path Following of Underactuated Marine Surface Vessels Using Line of Sight Based Model Predictive Control[J]. Ocean Engineering, 2010, 37(2-3): 289- 295. [7] 边信黔, 程相勤, 贾鹤鸣, 等. 基于迭代滑模增量反馈的欠驱动AUV地形跟踪控制[J]. 控制与决策, 2011, 26(2): 289-292, 296.Bian Xin-qian, Cheng Xiang-qin, Jia He-ming, et al. A Bottom-following Controller for Underactuated AUV Based on Iterative Sliding and Increment Feedback[J]. Control and Decision, 2011, 26(2): 289-292, 296. [8] 高剑, 李勇强, 李璐琼, 等. 基于航路点跟踪的AUV回收控制[J]. 火力与指挥控制, 2013, 38(8): 103-106.Gao Jian, Li Yong-qiang, Li Lu-qiong, et al. Autonomous Recovery of an AUV Based on Way-Point Tracking Control[J]. Fire Control & Command Control, 2013, 38(8): 103-106. [9] 严浙平, 宋金雪. 模型辅助和洋流估计下的UUV导航定位方法[J]. 水下无人系统学报, 2017, 25(5): 319-325.Yan Zhe-ping, Song Jin-xue. UUV Navigation and Posi-tioning Method Based on Model-Aided and Ocean Current Estimation[J]. Journal of Unmanned Undersea Systems, 2017, 25(5): 319-325. [10] 周佳加, 边信黔, 王宏健, 等. 基于小波的无人潜航器航位推算算法研究[J]. 仪器仪表学报, 2012, 33(3): 670-676.Zhou Jia-jia, Bian Xin-qian, Wang Hong-jian, et al. Study on Dead Reckoning Method for Unmanned Underwate Vehicle Based on Wavelet[J]. Chinese Journal of Scientific Instrument, 2012, 33(3): 670-676.
点击查看大图
计量
- 文章访问数: 618
- HTML全文浏览量: 17
- PDF下载量: 276
- 被引次数: 0