为应对现有基于水声定位的组合导航方法中,信标应答信号接收不稳定,以及因声速误差导致的测距误差对导航性能的影响,提出一种紧组合导航方法。基于扩展卡尔曼滤波方法,以航速、航迹角定点运动学方程以及声速随机扰动为系统方程,使用时延作为观测量,根据接收到的随机数量的时延信息,自适应构建观测方程,以实现对信标应答信号各种接收情况的自适应处理。经过在青岛近海的实验验证,此方法数据利用率高,且具有更快的收敛速度和更高的定位精度。此外,它还能够有效地估计海水的平均声速,具备一定的实用性。
In response to the challenges present in existing combined navigation methods based on underwater acoustics, which involve unstable reception of beacon response signals and the impact of range measurement errors due to sound velocity inaccuracies on navigation performance, we propose an integrated navigation approach. Grounded in the Extended Kalman Filtering methodology and employing the fixed-point kinematic equations of watercraft velocity and heading, as well as random sound velocity disturbances as system equations, we utilize time delays as observational data. Adaptive construction of observation equations is achieved based on the received, randomly varying time delay information, enabling adaptive processing of beacon response signals under various reception scenarios. Through validation with experimental data obtained in the vicinity of Qingdao's coastal waters, this method exhibits high data utilization rates, faster convergence, and superior positioning accuracy. Furthermore, it demonstrates the capability to effectively estimate the average sound velocity of seawater, enhancing its practical utility.
2024,46(15): 135-139 收稿日期:2023-10-07
DOI:10.3404/j.issn.1672-7649.2024.15.024
分类号:TP24
作者简介:邵虎林(1998 – ),男,硕士,研究方向为水下导航定位
参考文献:
[1] 高清泽. 一种水下航行器运动自导航及轨迹跟踪方法[J]. 舰船科学技术. 2019, 41(4): 94–99.
[2] 黄玉龙, 张勇刚, 赵玉新. 自主水下航行器导航方法综述[J]. 水下无人系统学报. 2019, 27(3): 232–253.
[3] 潘爽, 施建礼, 聂永芳, 等. 自主水下航行器同时定位与制图技术研究[J]. 舰船科学技术. 2018, 40(6): 124–127.
[4] 于燕婷, 许江宁, 林恩凡, 等. 单信标水声定位技术研究现状及应用展望[J]. 导航定位学报. 2022, 10(2): 13–20.
[5] 曹方方, 刘卫东, 李娟丽. 基于EKF的UUV单信标水声导航定位方法研究[J]. 计算机测量与控制. 2011, 19(9): 2234–2236.
[6] BATISTA P, SILVESTRE C, OLIVEIRA P. Single beacon navigation: Observability analysis and filter design[C] //IEEE, 2010.
[7] S. E W, L. L W, R. M E. Advances in decentralized single-beacon acoustic navigation for underwater vehicles: Theory and simulation[C]// 2010.
[8] 王燕, 张新宇, 孙思博, 等. 水下单信标导航算法研究及置信区间分析[J]. 哈尔滨工程大学学报. 2022, 43(1): 119–129.
[9] 邝英才, 吕志平, 李林阳, 等. GNSS-A水下定位的动态非线性Gauss-Helmert模型及其抗差总体卡尔曼滤波算法[J]. 测绘学报, 2023, 52(4): 559-570.
[10] 孙伟, 段顺利, 丁伟, 等. GPS单点测速方法的比较分析[J]. 导航定位学报. 2017, 5(1): 81–85.
[11] 辛明真, 阳凡林, 薛树强, 等. 顾及波束入射角的常梯度声线跟踪水下定位算法[J]. 测绘学报. 2020, 49(12): 1535–1542.