Underwater Localization Method of AUV Based on Single Beacon Bearing-Only Measurement
-
摘要: 在信标深度已知条件下, 提出了一种基于单信标纯方位信息测量的自主水下航行器(AUV)实时定位方法, 以解决单信标AUV水下定位中遇到的问题。不同于传统基于单信标测距信息方法, 文中从坐标变换原理出发, 构建了2自由度(2-DOF)姿态的AUV运动模型, 推导了深度已知条件下纯方位AUV定位的状态空间模型, 在所建立模型的基础上采用扩展卡尔曼滤波器(EKF)进行求解, 并针对EKF算法应用给出了一种滤波器调参方法, 通过构建仿真试验对所提出方法进行了有效性验证, 并将其与现有方法进行了对比分析。结果表明, 在该仿真条件下, 文中基于单信标方位观测模型的方法在滤波精度上要好于基于测距信息的方法, 且收敛性能优于后者。Abstract: Under the condition that the depth of a beacon is known, a real-time positioning method of an autonomous undersea vehicle(AUV) is presented based on single beacon bearing-only information measurement to solve the problem of single beacon AUV underwater localization. Different from the traditional method based on single beacon ranging information, the coordinate transformation principle is adopted to construct a 2-degree of freedom(2-DOF) attitude AUV motion model, and a state space model of bearing-only AUV localization problem is derived under the condition of knowing depth. Based on the established models, the extended Kalman filter(EKF) is used to solve the problem, and a filter parameter adjusting method is presented for the application of EKF algorithm. The validity of the proposed method is verified by a simulation experiment. Comparison between the proposed method and the existing method shows that the proposed method based on single beacon bearing observation model is better in filtering accuracy than that based on ranging information, and its convergence performance is superior to that of the latter.
-
[1] 孙大军, 郑翠娥. 水声导航、定位技术发展趋势探讨[J]. 海洋技术学报, 2015, 34(3): 64-65.Sun Da-jun, Zheng Cui-e. Discussion on Development Trend of Underwater Acoustic Navigation and Positioning Technology[J]. Journal of Marine Technology, 2015, 34(3): 64-65. [2] Alexander P S. The AUV Positioning Using Ranges from One Transponder LBL[C]//Proceedings of the 1995 MTS/ IEEE Oceans Conference. San Diego. CA, USA: IEEE, 1995. [3] Vaganay J, Baccou P, Jouvencel B. Homing by Acoustic Ranging to a Single Beacon[C]//Proceedings of the 2000 MTS/IEEE Oceans Conference. Providence, RI, USA: IEEE, 2000. [4] 曹俊, 郑翠娥, 孙大军, 等. 系数矩阵正定的单信标测距定位算法[J]. 电子与信息学报, 2017, 39(4): 981-988.Cao Jun, Zheng Cui-e, Sun Da-jun, et al. A Single Beacon Location Algorithm with Positive Definite Coefficient Matrix[J]. Journal of Electronics & Information Technology, 2017, 39(4): 981-988. [5] 曹俊, 郑翠娥, 孙大军, 等. AUV直线航迹下的单信标测距定位算法[J]. 哈尔滨工程大学学报, 2017, 38(5): 733-738.Cao Jun, Zheng Cui-e, Sun Da-jun, et al. AUV Positioning Based on Single-beacon Ranging in Straight-line Trajectory[J]. Journal of Harbin Engineering University, 2017, 38(5): 733-738. [6] 张福斌, 张永清. 一种利用单信标修正AUV定位误差的方法[J]. 鱼雷技术, 2012, 20(1): 38-41.Zhang Fu-bin, Zhang Yong-qing. Correcting Localization Error with a Single Beacon for AUV[J]. Torpedo Technology, 2012, 20(1): 38-41. [7] 曹方方, 刘卫东, 李娟丽. 基于EKF的UUV单信标水声导航定位方法研究[J]. 计算机测量与控制, 2011, 19 (9): 2234-2236.Cao Fang-fang, Liu Wei-dong, Li Juan-li. Navigating and Positioning Based on EKF for Unmanned Underwater Vehicle from A Single Beacon[J]. Computer Measurement & Control, 2011, 19(9): 2234-2236. [8] Vallicrosa G, Ridao P, Ribas D. AUV Single Beacon Range-Only SLAM with a SOG Filter[J]. IFAC-Papers- Online, 2015, 48(2): 26-31. [9] 严卫生, 房新鹏, 崔荣鑫. 单信标测距AUV水下定位系统观测性分析[J]. 中南大学学报(自然科学版), 2012, 43(8): 202-207.Yan Wei-sheng, Fang Xin-peng, Cui Rong-xin. Observability Analysis of Singlebeacon Underwater Localization of Autonomous Underwater Vehicle[J]. Journal of Central South University(Science and Technology), 2012, 43(8): 202-207. [10] 曹俊, 郑翠娥, 孙大军, 等. 水下载体的声学定位系统测距误差分析[J]. 南京大学学报(自然科学), 2016, 52 (5): 816-824.Cao Jun, Zheng Cui-e, Sun Da-jun. Ranging Error Analysis of Acoustic Positioning System for Underwater Vehicle[J]. Journal of Nanjing University(Natural Science), 2016, 52(5): 816-824. [11] Civera J, Davison A J M M. Inverse Depth Parameterization for Monocular SLAM[J]. IEEE Transactions on Robotics, 2008, 24(5): 932-945. [12] Matsebe O, Holtzhausen S, Kumile C M, et al. Modeling the Kinematics of an Autonomous Underwater Vehicle for Range-Bearing Simultaneous Localization and Mapping [C]//International Conference on Mechatronics and Machine Vision in Practice. Auckland, New Zealand: IEEE, 2009. [13] Becker C, Ribas D, Ridao P. Simultaneous Sonar Beacon Localization & AUV Navigation[J]. IFAC Proceedings Volumes, 2012, 45(27): 200-205. [14] Chaffield B. Fundamentals of High Accuracy Inertial Navigation[M]. Reston: AIAA Inc, 1997. [15] PereaL, How J, Breger L. Nonlinearity in Sensor Fusion: Divergence Issues in EKF, Modified Truncated SOF, and UKF[C]//Proceedings of AIAA Conference of Guidance, Navigation, and Control. South Carolina, USA: IEEE, 2007: 3489-3499. [16] Auger F, Hilairet M, Guerrero J M, et al. Industrial Applications of the Kalman Filter: A Review[J]. IEEE Transactions on Industrial Electronics, 2013, 60(12): 5458- 5471. [17] Gibbs, Bruce P. Advanced Kalman Filtering, Leastsquares and Modeling: a Practical Handbook[M]. Pennsylvania. US: John Wiley & Sons, Inc., 2011. [18] Hidalgo F, Bräunl T. Review of underwater SLAM techniques[C]//International Conference on Automation, Robotics and Applications. Queenstown, New Zealand , IEEE, 2015: 306-311. [19] Paz L M, Tardós J D, Neira J. Divide and Conquer: EKF SLAM in O(n)[J]. IEEE Transactions on Robotics, 2008, 24(5): 1107-1120.
点击查看大图
计量
- 文章访问数: 1013
- HTML全文浏览量: 16
- PDF下载量: 499
- 被引次数: 0