A Cooperative Localization Method of UUV Based on Unscented Kalman Filter
-
摘要: 多水下无人航行器(multi-UUV)协同定位技术是解决海洋中间层水下导航定位问题的重要途径, 针对以往multi-UUV仅靠距离量测的协同导航定位精度低的问题, 给出了一种基于无迹卡尔曼滤波 (UKF) 方法的UUV协同定位方法。利用从UUV的运动学方程和基于距离的量测方程建立了从UUV的导航模型, 针对该非线性导航模型,采用UKF设计了导航滤波算法, 避免了对非线性方程的线性化处理, 实现了递推导航滤波算法, 并与传统的航位推算方法进行了仿真对比。仿真结果表明, 从UUV能够利用该导航滤波算法进行实时定位, 比传统的航位推算方法具有更高的定位精度。Abstract: The multi-unmanned underwater vehicles (multi-UUV) cooperative localization technology is important for solving the UUV localization problem in middle depth zone of the sea. To increase lower precision of multi-UUV cooperative localization using only range measurement, a cooperative localization method of UUV based on unscented Kalman filter (UKF) is presented in this paper. A follower UUV navigation model is derived from kinematic equation and measurement equation based on range of follower UUV. For the nonlinear navigation model, we designed navigation filtering algorithm using the UKF to avoid linearization of the nonlinear equations, and realized the recursive navigation filtering algorithm. Simulation results show that follower UUV can use the navigation filtering algorithm for real-time positioning. Compared with the traditional dead reckoning method, the new method has higher localization accuracy.
-
[1] Vaganay J, Leonard J J, Curcio J A, et al. Experimental Validation of the Moving Long Base-Line Navigation Concept[C]//Autonomous Underwater Vehicles, 2004 IEEE/ OES: 59-65. [2] Willumsen, Hallingstad A B, Jalving O, et al. Integration of Range, Bearing and Doppler Measurements from Trans- ponders into Underwater Vehicle Navigation Systems[C]// in Oceans 2006, 2006: 1-6. [3] Lee P, Jun B, Kim K, et al. Simulation of an Inertial Acoustic Navigation System with Range Aiding for an Autonomous Underwater Vehicle[J]. IEEE Journal of Oceanic Engineering, 2007, 32(2): 327-345. [4] Larsen M B. High Performance Doppler-inertial Navigation Experimental Results[C]//In IEEE Oceans, RI, USA, 2000: 2043-2050. [5] Baccou P, Jouvencel B. Homing and Navigation Using one Transponder for UUV, Post-processing Comparisons Results with Long Base-line Navigation[C]//Proceedings IEEE International Conference on Robotics and Automation, 2002: 4004-4009. [6] Baccou P, Jouvencel B. Simulation Results, Post-processing Experimentations and Comparisons Results for Navigation, Homing and Multiple Vehicles Operations with a New Positioning Method Using on Transponder[C]//Intelligent Robots and Systems, 2003 IEEE/RSJ International Conference, 2003: 811- 817. [7] Gader A, Stilwell D. Toward Underwater Navigation Based on Range Measurements from a Single Localization[C]// Proceedings of IEEE International Conference on Robotics and Automation, New Orleans, 2004: 1-6. [8] Alexander B, John J L. Cooperative Localization for Autonomous Underwater Vehicles[C]//Springer Tracts in Advanced Robotics, 2008: 387-395. [9] Engel,Kalwa R. Relative Positioning of Multiple Underwater Vehicles in the GREX project[C]//IEEE:Oceans 2009 Europe. Bremen, 2009:1-7. [10] Zhang Li-chuan, Liu Ming-yong, Xu De-min, et al. Coope- rative Localization for Underwater Vehicles[C]//ICIEA IEEE, 2009: 2524-2527. [11] 张立川, 刘明雍, 徐德民. 基于水声传播延迟的主从式多无人水下航行器协同导航定位研究[J].兵工学报, 2009, 30(12): 1674-1678.Zhang Li-chuan, Liu Ming-yong , Xu De-min. Cooperative Localization for Multi-UUVs Based on Time-of-flight of Acoustic Signal[J]. Acta ArmamentarII, 2009, 30(12): 1674- 1678. [12] Singh S, Grund M, Bingham B, et al. Underwater Acoustic Navigation with the WHOI Micro-Modem[C]//Oceans 2006, Boston, 2006. [13] Julier J, Uhlmann K. Unscented and Nonlinear Estimation [J]. Proceeding of the IEEE, 2004, 92(3):401-422.
点击查看大图
计量
- 文章访问数: 1657
- HTML全文浏览量: 0
- PDF下载量: 734
- 被引次数: 0