• 中国科技核心期刊
  • Scopus收录期刊
  • DOAJ收录期刊
  • JST收录期刊
  • Euro Pub收录期刊
LI Zhi-wei, YUE Wei, GAO Sheng-feng, CAI Peng, ZHU Hai-rong. The SINS/DVL Integrated Navigation Algorithm Based on Observable Degree Feedback[J]. Journal of Unmanned Undersea Systems, 2020, 28(2): 155-161. doi: 10.11993/j.issn.2096-3920.2020.02.006
Citation: LI Zhi-wei, YUE Wei, GAO Sheng-feng, CAI Peng, ZHU Hai-rong. The SINS/DVL Integrated Navigation Algorithm Based on Observable Degree Feedback[J]. Journal of Unmanned Undersea Systems, 2020, 28(2): 155-161. doi: 10.11993/j.issn.2096-3920.2020.02.006

The SINS/DVL Integrated Navigation Algorithm Based on Observable Degree Feedback

doi: 10.11993/j.issn.2096-3920.2020.02.006
  • Received Date: 2019-04-17
  • Rev Recd Date: 2019-07-28
  • Publish Date: 2020-04-30
  • Aiming at the problem that some system states in strap-down inertial navigation system(SINS)/Doppler velocity log(DVL) integrated navigation have significant influence on navigation accuracy but have relatively weak observability, a SINS/DVL integrated navigation algorithm based on observable degree feedback is proposed. The algorithm quantitatively analyzes the observability of each state parameter of the system, and constructs an adaptive factor based on observability feedback according to the fact that the observability of the system state parameters depends on maneuver states in order to increase the estimated proportion of state parameters when they have high observable degree, and so as to improve the adaptability and accuracy of the algorithm. The performance of the proposed algorithm is verified through lake trial, and the results show that the accumulated error of this observable degree feedback filtering algorithm is obviously smaller than that of the conventional Kalman filter algorithm, and the autonomous navigation time of the SINS/DVL integrated navigation can be prolonged under the same accuracy requirement.

     

  • loading
  • [1]
    冯正平. 国外自治水下机器人发展现状综述[J]. 鱼雷技术, 2005, 13(1): 5-9.

    Feng Zheng-ping. A Review of the Development of Autonomous Underwater Vehicles(AUVs) in Western Countries[J]. Torpedo Technology, 2005, 13(1): 5-9.
    [2]
    Hayato K, Tamaki U. Navigation of an AUV for Investigation of Underwater Structures[J]. Control Engineering Practice, 2004, 12(12): 1551-1559.
    [3]
    Yaruui G, Martins R, Sousa J. Accuracy Analysis of DVL/ IMUI Magnetometer Integrated Navigation System using Different IMUs in AUV[C]//Proceedings of the 2010 8th IEEE International Conference on Control and Automation, Xiamen, China: ICCA, 2010: 519-521.
    [4]
    徐晓苏, 潘永飞, 邹海军. 基于自适应滤波的SINS/ DVL组合导航系统[J]. 华中科技大学学报(自然科学版), 2015, 43(2): 48-53.

    Xu Xiao-su, Pan Yong-fei, Zou Hai-jun. SINS/DVL Integrated Navigation System Based on Adaptive Filtering[J]. Journal of Huazhong University of Science and Technology(Nature Science Edition), 2015, 43(2): 48-53.
    [5]
    徐晓苏, 董亚, 童金武, 等. 基于5阶球面最简相径的改进型容积卡尔曼滤波在SINS/DVL组合导航中的应用[J]. 中国惯性技术学报, 2017, 25(3): 343-348.

    Xu Xiao-su, Dong Ya, Tong Jin-wu, et al. Improved Fifth-degree Spherical Simplex Sadial Cubature Kalman Filter in SINS/DVL Integrated Navigation[J]. Journal of Chinese Inertial Technology, 2017, 25(3): 343-348.
    [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]
    严涛, 王跃钢, 杨波, 等. SINS/DR组合导航系统可观测性研究[J]. 现代防御技术, 2012, 40(3): 83-87.

    Yan Tao, Wang Yue-gang, Yang Bo, et al. Observability of SINS/DR Integrated Navigation System[J]. Modern Defence Technology, 2012, 40(3): 83-87.
    [8]
    Goshen-Meskin D, Bar-Itzhack I Y. Observability Analysis of Piece-wise Constant Systems. II. Application to Inertial Navigation In-flight Alignment[J]. IEEE Transactions on Aerospace and Electronic Systems, 1992, 28(4): 1068-1075.
    [9]
    Wu Y X, Wu M P, Hu X P. Self-calibration for Land Navigation Using Inertial Sensors and Odometer: Observability Analysis[C]//AIAA Guidance, Navigation and Control Conference, Chicago, Illinois, USA: AIAA, 2010: 964-969.
    [10]
    帅平, 陈定昌, 江涌. GPS/SINS组合导航系统状态的可观测度分析方法[J]. 宇航学报, 2004, 12(2): 219-224.

    Shuai Ping, Chen Ding-chang, Jiang Yong. Observable Degree Analysis Method of Integrated GPS/SINS Navigation System[J]. Journal of Astronautics, 2004, 12(2): 219- 224.
    [11]
    杨晓霞, 黄一. 外场标定条件下捷联惯导系统误差状态可观测性分析[J]. 中国惯性技术学报, 2008, 16(6): 1-8.

    Yang Xiao-xia, Huang Yi. Observability Analysis for the Error States of SINS Under the Outer Field Conditions[J]. Journal of Chinese Inertial Technology, 2008, 16(6): 1-8.
    [12]
    孔星炜, 董景新, 吉庆昌, 等. 一种基于PWCS的惯导系统可观测度分析方法[J]. 中国惯性技术学报, 2011, 19(6): 631-636.

    Kong Xing-wei, Dong Jing-xin, Ji Qing-chang, et a1. INS Observability Degree Analysis Method Based on PWCS[J]. Journal of Chinese Inertial Technology, 2011, 19(6): 631-636.
    [13]
    马艳红, 胡军. 基于SVD理论的可观测度分析方法的几个反例[J]. 中国惯性技术学报, 2008, 16(4): 448-457.

    Ma Yan-hong, Hu Jun. Counterexamples for Degree of Observability Analysis Method Based on SVD Theory[J]. Journal of Chinese Inertial Technology, 2008, 16(4): 448- 457.
    [14]
    杨晓霞, 阴玉梅. 可观测度的探讨及其在捷联惯导系统可观测性分析中的应用[J]. 中国惯性技术学报, 2012, 20(4): 405-409.

    Yang Xiao-xia,Yin Yu-mei. Discussions on Observability and Its Applications in SINS[J]. Journal of Chinese Inertial Technology, 2012, 20(4): 405-409.
    [15]
    Ham F M, Brown T G. Observability, Eigenvalues, and Kalman filtering[J]. IEEE Transactions on Aerospace and Electronic Systems, 1983, 19(2): 269-273.
    [16]
    章大勇. 激光雷达-惯性组合导航系统的一致性与最优估计问题研究[D]. 长沙: 国防科学技术大学, 2010.
  • 加载中

Catalog

    通讯作者: 陈斌, bchen63@163.com
    • 1. 

      沈阳化工大学材料科学与工程学院 沈阳 110142

    1. 本站搜索
    2. 百度学术搜索
    3. 万方数据库搜索
    4. CNKI搜索

    Article Metrics

    Article Views(673) PDF Downloads(173) Cited by()
    Proportional views
    Related
    Service
    Subscribe

    /

    DownLoad:  Full-Size Img  PowerPoint
    Return
    Return