基于条件数的多自主水下航行器协同定位系统可观测度分析

doi:10.3969/j.issn.1000-1093.2015.01.020

摘要/Abstract

摘要： 针对基于移动长基线的多自主水下航行器（MAUV）协同定位系统，建立了MAUV的2D运动学模型与距离量测方程。利用基于Lie导数的非线性系统可观测性理论，得到协同定位系统可观测矩阵及MAUV编队的不可观测航行路径。利用奇异值分解（SVD）理论获得系统可观测矩阵的条件数，建立了协同定位系统可观测度的评价函数，并在不同MAUV航行队形对系统可观测度进行仿真分析。结果表明，系统可观测度随着MAUV航行队形的不同而变化，从而为通过变换队形来提高协同定位性能提供了有效的参考依据。

关键词: 信息处理技术, 多自主水下航行器, 协同定位, 条件数, 可观测度

Abstract: For the multiple autonomous underwater vehicle (MAUV) cooperative localization system based on the moving long baseline, the 2D kinematic models and range measurement equations of MAUV are established.The observability theory of nonlinear system based on Lie derivatives is used to derive the observability matrix of the cooperative localization system and describe the unobservable trajectories of MAUV system. The evaluation function for the observability metric of the localization system is given using the condition number of observability matrix obtained from singular value decomposition(SVD) theory. Finally, a series of simulation experiments are designed to analyze the system observability under the different MAUV formations. The results show that the system observability change with the MAUV formation, which provides an effective reference to improve the performance of cooperative localization system by transforming the MAUV formation.

Key words: information processing technology, multiple autonomous underwater vehicle, cooperative localization, condition number, observability

中图分类号:

TP391

马朋，张福斌，徐德民，刘书强. 基于条件数的多自主水下航行器协同定位系统可观测度分析[J]. 兵工学报, 2015, 36(1): 138-143.

MA Peng， ZHANG Fu-bin， XU De-min， LIU Shu-qiang. Observability Analysis of Cooperative Localization System for MAUV Based on Condition Number[J]. Acta Armamentarii, 2015, 36(1): 138-143.

参考文献

［1］邢光谦. 量测系统的能观度和状态估计精度[J]. 自动化学报, 1985, 11(2): 152-158.
XING Guang-qian. Degree of observability and accuracy of state estimate for general measurement system[J]. Acta Automatica Sinica, 1985, 11(2): 152-158. (in Chinese)
[2] Gadre A, Stilwell D. Underwater navigation in the presence of unknown currents based on range measurements from a single location[C]∥Proceedings of the 2005 American Control Conference. Portland. US：IEEE，2005：656-661.
[3] Lee P, Jun B, Lim Y. Review on underwater navigation system based on range measurements from one reference [C]∥OCEANS 2008-MTS/IEEE Kobe Techno-Ocean. Kobe, Japan: MTS/IEEE, 2008:1-5.
[4] Zhou X，Roumeliotis S. Robot-to-robot relative pose estimation from range measurements[J]. IEEE Transactions on Robots, 2008, 24(6): 1379-1393.
[5] Antonelli G, Arrichiello F, Chiaverini S, et al. Observability analysis of relative localization for AUVs based on ranging and depth measurements[C]∥2010 IEEE International Conference on Robotics and Automation (ICRA). San Francisco, US: IEEE, 2010: 4276-4281.
[6] Antonelli G, Caiti A, Calare V, et al. Designing behaviors to improve observability for relative localization of AUVs [C]∥IEEE International Conference on Robotics and Auto- mation (ICRA). Anchorage, US：IEEE，2010: 4270-4275.
[7] Martinelli A, Siegwart R. Observability analysis for mobile robot localization[C]∥2005 IEEE/RSJ International Conference on Intelligent Robots and Systems. Anchorage, US: IEEE, 2005:1471-1476.
[8] 房新鹏, 严卫生, 李俊兵. 基于距离量测的主从式AUV协同定位系统可观测性研究[J]. 西北工业大学学报, 2012, 30(4): 547-552.
FANG Xin-peng，YAN Wei-sheng, LI Jun-bing. An effective observability analysis for the leader-follower autonomous underwater vehicles (AUVs) cooperative localization based on range measurements[J]. Journal of Northwestern Polytechnical University, 2012, 30(4): 547-552.(in Chinese)
[9] Sharma R, Beard R, Taylor C, et al. Graph-based observability analysis of bearing-only cooperative localization[J]. IEEE Transactions on Robots, 2012, 28(2): 522-529.
[10] 常晓华, 崔平远, 王晓明, 等. 基于条件数的能观性度量方法及在自主导航系统中的应用[J]．宇航学报, 2010, 31(5): 1331-1337．
CHANG Xiao-hua, CUI Ping-yuan, WANG Xiao-ming, et al. A condition number-based observability analysis method and its application in autonomous navigation system[J]. Journal of Astronautics, 2010, 31(5): 1331-1337. (in Chinese)
[11] Ham F, Brown R. Observability, eigenvalues, and Kalman filtering[J]. IEEE Transactions on Aerospace and Electronic Systems, 1983, 19(2): 269-273.
[12] Arrichiello F, Antonelli G, Aguiar A, et al. Observability metric of the relative localization for AUVs based on range and depth measurements: theory and experi- ments[C]∥2011 IEEE/RSJ International Conference on Intelligent Robots and Systems(ICIRS). San Francisco, US : IEEE/RSJ, 2011: 3166-3171.
[13] Arrichiello F, Antonelli G, Aguiar A, et al. An observability metric for underwater vehicle localization using range measurements[J]. Sensors, 2013, 13(12)：16191-16215.
[14] Long R, Qin Y, Jia J. Observable degree analysis of SINS initial alignment based on singular value decomposition[C]∥IEEE International Symposium on Knowledge Acquisition and Modeling Workshop. Wuhan, China：IEEE，2008: 444-448.
[15] 马艳红, 胡军. 基于SVD理论的可观测度分析方法的几个反例[J]. 中国惯性技术学报, 2008, 16(4): 448-452.
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-452. (in Chinese)
[16] Maessen D, Gill E. Relative state estimation and observability analysis for formation flying satellites[J]. Journal of Guidance, Control, and Dynamics, 2012, 35(1): 321-326.
[17] Li M, Wang D, Huang X. Study on the observability analysis based on the trace of error covariance matrix for spacecraft autonomous navigation[C]∥IEEE International Conference on Control and Automation(ICCA). Hangzhou, China: IEEE, 2013: 95-98.
[18] Vaganay J, Leonard J, Curcio J, et al. Experimental validation of the moving long baseline navigation con- cept[C]∥IEEE/OES Autonomous Underwater Vehicles. US: IEEE/OES, 2004: 59-65.
[19] Isidori A.非线性控制系统[M]. 第3版. 王奔, 庄圣贤,译. 北京: 电子工业出版社, 2005.
Isidori A. Nonlinear control system [M]. 3rd ed. WANG Beng, ZHUANG Sheng-xian ,translated. Beijing: Publishing House of Electronics Industry, 2005. (in Chinese)
[20] 张贤达. 矩阵分析与应用[M]. 北京: 清华大学出版社, 2004.
ZHANG Xian-da. Matrix analysis and applications[M].Beijing: Tsinghua University Press, 2004. (in Chinese)

[1]	傅晋博, 张栋, 王孟阳, 赵军民. 面向目标定位精度提升的无人机航迹规划[J]. 兵工学报, 2023, 44(11): 3394-3406.
[2]	赵建博，杨树兴，熊芬芬. 基于领弹-从弹架构的无导引头导弹协同定位与制导方法[J]. 兵工学报, 2019, 40(4): 673-679.
[3]	徐博，李盛新，金坤明，王连钊. 基于径向基函数神经网络辅助容积卡尔曼滤波的多自主水下航行器协同定位方法[J]. 兵工学报, 2019, 40(10): 2119-2128.
[4]	曾溢良，蓝金辉，邹金霖. 滑动置信度约束的红外弱小目标跟踪算法研究[J]. 兵工学报, 2017, 38(9): 1771-1778.
[5]	李关防，崔杰，袁富宇. 基于线谱瞬时频率估计的被动声纳目标运动分析[J]. 兵工学报, 2017, 38(7): 1395-1401.
[6]	朱甦，薄煜明，何亮. 基于冗余字典的多特征压缩感知目标跟踪算法[J]. 兵工学报, 2017, 38(6): 1140-1146.
[7]	王啸, 韩太林, 张永立, 刘轩, 王义君, 宫玉琳. 多通道瞬态信号自适应变频算法[J]. 兵工学报, 2017, 38(6): 1161-1167.
[8]	张石，张百海，王飞帆，关子霄. 基于跳数量化的无线传感器网络节点定位算法[J]. 兵工学报, 2017, 38(5): 932-939.
[9]	夏平, 任强, 吴涛, 雷帮军. 融合多尺度统计信息模糊C均值聚类与Markov随机场的小波域声纳图像分割[J]. 兵工学报, 2017, 38(5): 940-948.
[10]	曹俊，郑翠娥，孙大军，张殿伦. 基于凸优化的水下载体定位研究[J]. 兵工学报, 2017, 38(3): 520-526.
[11]	向颉，茅永兴，郭才发. 船载雷达测速数据的船速修正新方法[J]. 兵工学报, 2017, 38(11): 2268-2273.
[12]	潘江怀，乔慧. 多传感器空间配准的病态性及其稳健估计[J]. 兵工学报, 2017, 38(10): 1965-1973.
[13]	王清，丁赤飚，付琨，任文娟. 基于膨胀运算的移动对象兴趣点检测方法[J]. 兵工学报, 2017, 38(10): 2041-2047.
[14]	李子高，李淑秋，闻疏琳. 一种基于独立成分分析的水下宽带信号波达方位估计方法[J]. 兵工学报, 2017, 38(1): 114-122.
[15]	刘泳庆，蒋硕，于栋，邵晓田. 窄带干扰抑制对码相位测量零值的影响分析[J]. 兵工学报, 2016, 37(2): 293-298.