Design and Implementation of Dynamic Positioning System for a Fully Actuated AUV
-
摘要: 针对全驱动自主水下航行器(AUV)近水面运动控制由于自身惯量小, 面对环境扰动极为敏感的问题, 提出一种基于比例-积分-微分(PID)的动力定位控制方法。结合自主研发的“探海I型”AUV样机, 介绍了AUV系统结构设计思想, 并利用光纤惯导、多普勒计程仪和深度计组成水下航位推算系统, 借助PID控制对位置和姿态误差进行调校, 以抵抗环境干扰。最后通过对湖试结果进行分析, 验证了AUV动力定位系统的实用性, 为今后水下搜救、目标定位等扩展应用研究提供参考。
-
关键词:
- 自主水下航行器 /
- 动力定位 /
- 比例-积分-微分控制 /
- 航位推算
Abstract: A dynamic positioning control method based on proportional-integral-derivative (PID) control for fully actuated autonomous undersea vehicle(AUV) is presented to solve the problem that AUV is sensitive to environmental disturbance due to its small inertia in the near-surface motion control. Taking the independently developed T-SEA I type AUV prototype for example, the structural design idea of the AUV system is introduced. The dead reckoning system is composed by optical fiber inertial navigation system, Doppler velocity log and depth gauge. The position and attitude errors are compensated by PID control to resist environmental disturbance. Lake test verifies the practicability of the dynamic positioning system. This study may provide a reference for future researches on underwater search and rescue, object location, and so on. -
[1] 王婷, 宋保维. 水下航行器多推进器动力定位控制[J]. 兵工学报, 2006, 27(5): 845-850.Wang Ting, Song Bao-wei. Control of Dynamic Position System for AUV with Multiple Thrusters[J]. Acta Arma-mentarii, 2006, 27(5): 845-850. [2] Tanakitkorn K, Wilson P A, Turnock S R, et al. Depth Control for an Over-actuated, Hover-capable Autonomous Underwater Vehicle with Experimental Verification[J]. Mechatronics, 2017, 41: 67-81. [3] 刘慧婷, 张明, 曾庆军, 等. 水下机器人抗波浪扰动动力定位研究[J]. 计算机测量与控制, 2016, 24(1): 199-203.Liu Hui-ting, Zhang Ming, Zeng Qing-jun, et al. Research on Dynamic Positioning of ROV Anti-waves[J]. Computer Measurement & Control, 2016, 24(1): 199-203. [4] You H E, Chitre M, Ng K M, et al. Minimum Speed Seeking Control for Nonhovering Autonomous Underwater Vehicles[J]. Journal of Field Robotics, 2016, 33(5): 706-733. [5] 高剑, 徐德民. 基于自适应反演滑模控制的AUV水平面动力定位方法[J]. 机械科学与技术, 2007, 26(6): 738-740.Gao Jian, Xu De-min. Backstepping Sliding Mode Control of Dynamic Positioning of an Autonomous Underwater Vehicle(AUV)[J]. Mechanical Science and Technology for Aerospace Engineering, 2007, 26(6): 738-740. [6] Sarkar M, Nandy S, Vadali S R K, et al. Modelling and Simulation of a Robust Energy Efficient AUV Controller[J]. Mathematics & Computers in Simulation, 2016, 121(C): 34-47. [7] 葛晖, 敬忠良. 海流作用下全驱动自主式水下航行器环境最优动力定位控制[J]. 上海交通大学学报, 2011, 45(7): 961-965.Ge Hui, Jing Zhong-liang. Weather Optimal Dynamic Po-sitioning Control of Fully Actuated Autonomous Under-water Vehicles with Current[J]. Journal of Shanghai Jiaotong University, 2011, 45(7): 961-965. [8] Aguiar A P, Pascoal A M. Dynamic Positioning and Way-point Tracking of Underactuated AUVs in the Presence of Ocean Currents[J]. International Journal of Con-trol, 2007, 80(7): 1092-1108. [9] Pyo J, Cho H, Joe H, et al. Development of Hovering Type AUV “Cyclops” and Its Performance Evaluation Using Image Mosaicing[J]. Ocean Engineering, 2015, 109: 517-530. [10] 郑荣才, 宋健力, 黎琼, 等. 船舶动力定位系统[J]. 中国惯性技术学报, 2013, 21(4): 495-499.Zheng Rong-cai, Song Jian-li, Li Qiong, et al. Dynamic Positioning System of Ship[J]. Journal of Chinese Inertial Technology, 2013, 21(4): 495-499. [11] 赵俊波, 葛锡云, 冯雪磊, 等. 水下SINS/DVL组合导航技术综述[J]. 水下无人系统学报, 2018, 26(1): 2-9.Zhao jun-bo, Ge Xi-yun, Feng Xue-lei, et al. A Review of Underwater SINS/DVL Integrated Navigation Technology[J]. Journal of Unmanned Undersea Systems, 2018, 26(1): 2-9. [12] 赵琳, 程建华, 赵玉新. 船舶导航定位系统[M]. 哈尔滨: 哈尔滨工程大学出版社, 2011. [13] 周佳加, 边信黔, 王宏健, 等. 基于小波的无人潜航器航位推算算法研究[J]. 仪器仪表学报, 2012, 33(3): 670-676.Zhou Jia-jia, Bian Xin-qian, Wang Hong-jian, et al. Study on Dead Reckoning Method for Unmanned Underwater Vehicle Based on Wavelet[J]. Chinese Journal of Scientific Instrument, 2012, 33(3): 670-676. [14] 严浙平, 宋金雪. 模型辅助和洋流估计下的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. [15] 覃军, 骆奇峰. 在Excel中实现统一椭球的高斯投影正反算[J]. 测绘与空间地理信息, 2009, 32(2): 205-208.Qin Jun, Luo Qi-feng. Unified Formula of Positive and Negative Computation of Gauss Projection of Ellipsoids Based on Excel[J]. Geomatics & Spatial Information Technology, 2009, 32(2): 205-208.
点击查看大图
计量
- 文章访问数: 809
- HTML全文浏览量: 4
- PDF下载量: 368
- 被引次数: 0