Model and Algorithm Improvement for Unmanned Undersea Vehicle Navigation Based on Single Beacon
-
摘要: 基于单信标的无人水下航行器(UUV)导航算法具有所需潜标数量少、系统海上布放标校简单、维护成本较低等优点, 结合UUV惯性导航系统后能够满足未来广域、低成本水下导航需求。针对单信标导航算法收敛速度较慢、非全局可观测等问题, 提出增加目标径向速度观测量的单信标水下导航算法; 分析了引入目标径向速度观测后的系统全局观测性, 给出新的导航初值估计及跟踪方法; 使用扩展卡尔曼滤波算法, 建立4状态变量-3观测量(4SV-3OB)单信标导航模型, 并通过数值仿真试验, 得出4SV-3OB模型相较于传统单信标导航模型收敛时间减小约75%。仿真结果表明, 增加目标径向速度作为系统观测量可有效简化单信标导航算法初值估计及跟踪流程, 并能够显著减小导航算法收敛时间。Abstract: In the single beacon-based unmanned undersea vehicle(UUV) navigation algorithm, a small number of beacons, simple deployment and calibration at sea, and low maintenance costs are required. If combined with the inertial navigation system, this algorithm is expected to fulfill the needs for wide-area and low-cost underwater navigation. To solve the problems regarding its slow convergence speed and non-global observability, a single beacon underwater navigation algorithm, which increased target radial velocity observations, is proposed. The global observability of the system after the introduction of the target radial velocity observation is thereafter analyzed, and a new method to estimate the initial value and track the navigation is derived. Afterward, by combining this method with the extended Kalman filter algorithm, a 4-state 3-observation(4SV-3OB) single beacon navigation model is established. Finally, numerical simulations indicate that the convergence time of the 4SV-3OB is approximately 75% lower than that of the traditional single beacon navigation model. Simulation results show that adding the target radial velocity as a system observation can effectively simplify the process of initial value estimation and tracking in the single beacon navigation algorithm and can significantly reduce the convergence time of the navigation algorithm.
-
[1] Paull L, Saeedi S, Seto M, et al. AUV Navigation and Localization: A Review[J]. IEEE Journal of Oceanic Engineering, 2014, 39(1): 131-149. [2] iXblue. Marins Series Military & Strategic Grades Inertial Navigation Systems(INS)[EB/OL]. [2021-07-20]. https:// www.ixblue.com/sites/default/files/2021-05/marion-series_2020.pdf. [3] Wang H, Fu G, Li J, et al. Strong Tracking CKF Based SLAM Method for Unmanned Underwater Vehicle[J]. Chinese Journal of Scientific Instrument, 2013, 34(11): 2542-2550. [4] Zhang J, Shi C, Sun D, et al. High-precision, Limited-beacon-aided AUV Localization Algorithm[J]. Ocean Engineering, 2018, 149: 106-112. [5] Vaganay J, Baccou P, Jouvencel B. Homing by acoustic ranging to a single beacon[C]//OCEANS 2000 MTS/IEEE Conference and Exhibition. Conference Proceedings(Cat. No.00CH37158). Providence, RI, USA: IEEE, 2000. [6] Gadre A S, Stilwell D J. A Complete Solution to Underwater Navigation in the Presence of Unknown Currents Based on Range Measurements from a Single Location[C]//2005 IEEE/RSJ International Conference on Intelligent Robots and Systems. Edmonton, AB, Canada: IEEE, 2005. [7] Gadre A S, Stilwell D J. Toward Underwater Navigation Based on Range Measurements from a Single Location[C]//IEEE International Conference on Robotics and Automation. New Orleans, LA, USA: IEEE, 2004. [8] Zhu Z, Hu S J. Model and Algorithm Improvement on Single Beacon Underwater Tracking[J]. IEEE Journal of Oceanic Engineering, 2018, 43(4): 1143-1160. [9] Zhu Z, Hu S J. Model and Algorithm Improvement on Single Beacon Underwater Tracking[J]. IEEE Journal of Oceanic Engineering, 2018, 43(4): 1143-1160. [10] Deng Z, Yu X, Zhu Z, et al. Adaptive Kalman Filter Based Single Beacon Underwater Tracking With Unknown Ef-fective Sound Velocity[J]. Sensors, 2018, 18(12): 1-18. [11] Qiao G, Asim I, Feng Z, et al. Experimental Assessment of a Multiple Sequence Direct Sequence Spread Spectrum (MS-DSSS) Underwater Acoustic Communication Scheme [C]//2013 OCEANS-San Diego. San Diego, CA, USA: IEEE. 2013. [12] 韩正之, 潘丹杰, 张钟俊. 非线性系统的能观性和状态观测器[J]. 控制理论与应用, 1990(4): 1-9.Han Zheng-zhi, Pan Dan-jie, Zhang Zhong-jun. Observability and Observers of Nonlinear Systems[J]. Control Theory & Applications, 1990(4): 1-9. [13] 刘明雍, 李闻白, 刘富樯, 等. 基于单信标测距的水下导航系统可观测性分析[J]. 西北工业大学学报, 2011, 29(1): 87-92.Liu Ming-yong, Li Wen-bai, Liu Fu-qiang, et al. Observability Analysis for Underwater Navigation System Based on Range Measurements with a Single Beacon[J]. Journal of Northwestern Polytechnical University, 2011, 29(1): 87-92. [14] Wang S, Chen L, Hu H, et al. Single Beacon Based Localization of AUVs Using Moving Horizon Estimation [C]//2013 IEEE/RSJ International Conference on Intelligent Robots and Systems. Tokyo, Japan: IEEE, 2013.
点击查看大图
计量
- 文章访问数: 125
- HTML全文浏览量: 19
- PDF下载量: 67
- 被引次数: 0