A Post-Processing Method of Navigation Data for Leader AUV Based on Backward Calculating
-
摘要: 由于多自主水下航行器(AUV)协同导航系统在水下长时间工作时, 领航AUV无法接收外界信息, 其定位误差会逐渐发散进而影响整个系统的定位性能。针对该问题, 文中提出一种基于捷联惯导系统/多普勒计程仪(SINS/DVL)和SINS/DVL/全球定位系统(GPS)组合导航相结合的领航AUV导航数据后处理方法。领航AUV在水下采用SINS/DVL组合导航方式对导航数据进行正向解算, 并保存其在水下航行过程中产生的导航信息。领航AUV出水后接收GPS信号, 同时采用SINS/DVL与SINS/DVL/GPS 2种导航方式进行独立滤波, 滤波结束后逆向解算出领航AUV在水下累计的定位误差, 通过结合正向和逆向解算出的结果, 使领航AUV在水下累计的定位误差得到有效修正, 进而提高多AUV系统的整体定位性能。最后通过仿真对该方法的可行性与有效性进行了验证。该方法可用于海底地形扫描、海图绘制与水下探测等领域, 可进一步提升多AUV系统采集的水下任务数据的位置精度, 提高数据的准确性与实用性。Abstract: Since the leader autonomous undersea vehicle(AUV) cannot receive the external information if the multi-AUV cooperative navigation system works under water for a long time and its localization error will gradually diverge and affect the localization performance of the overall system, a post-processing method based on integrated navigation of strap-down inertial navigation system(SINS)/Doppler velocity log(DVL) and SINS/DVL/global positioning system(GPS) is proposed. Adopting SINS/DVL integrated navigation, the leader AUV processes the navigation information forwardly and stores the navigation information sampled during the process when AUV maneuvers, and then it receives the GPS information after coming out of water and uses the two navigation methods of SINS/DVL and SINS/DVL/GPS for independent filtering. After filtering, the leader AUV’s localization error accumulated under water is processed inversely to correct the localization error of the leader AUV through forward and backward calculating, so as to improve the localization performance of the overall multi-AUV system. Moreover, the feasibility and validity of the proposed post-processing method is verified through simulation. This method can be applied to underwater terrain scanning, sea chart drawing and underwater exploration to further improve localization accuracy of the underwater data sampled by multi-AUV and enhance veracity and usefulness of the data.
-
[1] Bahr A, Leonard J J. Cooperative Localization for Autonomous Underwater Vehicle[J]. The International Journal of Robotics Research, 2009, 28(6): 714-728. [2] Maczka D K, Gadre A S, Stilwell D J. Implementation of A Cooperative Navigation Algorithm on A Platoon of Autonomous Underwater Vehicles[C]//Oceans 2007. [S.l.]: IEEE, 2007. [3] 高伟, 刘亚龙, 徐博, 等. 基于双主交替领航的多AUV协同导航方法[J]. 哈尔滨工程大学学报, 2014, 35(6): 735-740.Gao Wei, Liu Ya-long, Xu Bo, et al. Multiple AUV Cooperative Navigation Based on Two Leaders Alternated Navigation[J]. Journal of Harbin Engineering University, 2014, 35(6): 735-740. [4] 黄玉龙, 张勇刚, 赵玉新. 自主水下航行器导航方法综述[J]. 水下无人系统学报, 2019, 27(3): 232-253.Huang Yu-long, Zhang Yong-gang, Zhao Yu-xin. Review of Autonomous Undersea Vehicle Navigation Methods[J]. Journal of Unmanned Undersea Systems, 2019, 27(3): 232-253. [5] 张立川, 许少峰, 刘明雍, 等. 多无人水下航行器协同导航定位研究进展[J]. 高技术通讯, 2016, 26(5): 475-482.Zhang Li-chuan, Xu Shao-feng, Liu Ming-yong, et al. Research Process of Multi-Unmanned Underwater Vehicle Cooperative and Positioning[J]. High Technology Letters, 2016, 26(5): 475-482. [6] 陈建华, 朱海, 王超, 等. 水下SINS/DVL紧组合导航算法[J]. 海军工程大学学报, 2017, 29(2): 108-112.Chen Jian-hua, Zhu Hai, Wang Chao, et al. Underwater SINS/DVL Tightly Integrated Navigation Algorithm[J]. Journal of Naval University of Engineering, 2017, 29(2): 108-112. [7] 曹忠义, 郑翠娥, 张殿伦. 声学多普勒速度仪安装误差校准方法[J]. 哈尔滨工程大学学报, 2013, 34(4): 434-439.Cao Zhong-yi, Zheng Cui-e, Zhang Dian-lun. Study on the Calibration of Installation Errors in An Acoustic Doppler Velocity Log[J]. Journal of Harbin Engineering University, 2013, 34(4): 434-439. [8] 张福斌, 马朋, 刘书强. 基于距离量测的双领航AUV见协同导航算法[J]. 系统工程理论与实践, 2016, 36(7): 1898-1904.Zhang Fu-bin, Ma Peng, Liu Shu-qiang. A Cooperative Navigation Algorithm for Two Leader AUVs Based on Range Measurements[J]. System Engineering-Theory & Practice, 2016, 36(7): 1898-1904. [9] 马平, 吕峰, 杜海莲, 等. 多传感器信息融合基本原理及应用[J]. 控制工程, 2006, 13(1): 48-53.Ma Ping, Lü Feng, Du Hai-lian, et al. Theory and Application of Multi-sensor Information Fusion[J]. Control Engineering of China, 2006, 13(1): 48-53. [10] 孙进, 孙晓苏, 刘义亭, 等. 基于逆向导航解算和数据融合的SINS传递对准方法[J]. 中国惯性技术学报, 2015, 12(6): 727-732.Sun Jin, Xu Xiao-su, Liu Yi-ting, et al. Transfer Alignment Method for SINS Based on Reverse Navigation Solution and Data Fusion[J]. Journal of China Inertial Technology, 2015, 12(6): 727-732. [11] 严恭敏, 严卫生, 徐德民. 逆向导航算法及其在捷联罗经动基座初始对准中的应用[C]//中国自动化学会控制理论专业委员会第二十七届中国控制会议论文集. 昆明: 中国自动化学会控制理论专业委员会, 2008.
点击查看大图
计量
- 文章访问数: 267
- HTML全文浏览量: 22
- PDF下载量: 169
- 被引次数: 0