文章标题：一种基于移动矢径的单信标测距定位算法

文章作者：朱子尧, 韩树平, 黄锐, 马鑫
关 键 字：单信标测距定位;移动矢径;扩展卡尔曼滤波;声速误差
文章摘要：针对水下航行器利用移动单信标进行同步式测距定位时受初始位置误差和声速误差影响的问题，给出一种基于移动矢径的单信标同步式测距定位算法。参考移动矢径的概念建立了移动单信标测距定位模型，利用扩展卡尔曼滤波算法实现了定位滤波算法的设计。仿真和试验结果表明：本文算法可以有效减小初始位置误差带来的定位误差，并对未知声速误差进行实时估计，显著提高了水下航行器的定位精度。