摘要

采用水下超短基线定位系统和捷联惯导系统组合对水下潜器进行导航时,未知的声速误差会严重影响组合导航的精度。顾及超短基线定位系统的噪声水平、阵列上接收单元的误差特性以及和捷联惯导系统在导航性能的互补性,基于平面波近似原理,建立了SINS/USBL紧组合系统的状态方程和量测方程,并对未改正的声速误差在线估计,提出一种超短基线定位系统和捷联惯导系统紧组合算法。新算法可以将非高斯的未知声速误差进行建模后进行估计,有效提高了捷联惯导系统的误差估计性能。仿真实验结果表明,新算法能有效估计未知声速误差,滤波收敛后的精度明显优于松组合方案,具有很强的实用性。