一种声速-位置联合估计的水声导航定位方法

摘要

长基线水声导航定位方法利用各信标到水下航行器的信号传播时间和等效声速来估计水下航行器的位置,但各信标到水下航行器的等效声速估计存在误差,导致定位误差较大,且随着导航距离的增加,定位误差呈增长趋势。针对这一问题,提出了一种基于粒子滤波的水声导航定位方法,将等效声速和水下航行器的位置作为估计状态参量,通过测量信标信号到水下航行器的传播时间,建立粒子滤波模型对其位置进行估计,准确地估计并跟踪等效声速变化,从而提高定位精度,减小估计误差。仿真结果表明,在水下航行器初始位置未知的情况下,与常规方法相比,文中所提方法的定位精度提高了4倍左右。