基于可观测度反馈的SINS/DVL组合导航算法

摘要

cqvip:针对捷联惯导/多普勒计程仪(SINS/DVL)组合导航中部分系统状态对无人水下航行器(UUV)导航精度影响较大但可观测性相对较弱的问题,提出一种基于可观测度反馈的SINS/DVL组合导航算法。该算法通过量化分析系统各状态参数的可观测性,根据系统状态参数在不同机动状态下可观测度不同的特点,构造基于可观测度反馈的自适应调节因子,增加高可观测度时的系统状态参数的估计占比,以此来提高组合导航滤波算法的适应性和滤波估计精度。利用湖试数据对上述算法的性能进行了验证。结果表明,可观测度反馈滤波算法累积误差明显小于常规卡尔曼滤波算法,在相同的精度要求下,可延长水下SINS/DVL组合导航自主航行的时间。