基于不变误差定义的INS/USBL紧组合导航算法

针对现有惯性导航系统/超短基线定位系统（INS/USBL）组合导航算法误差定义不准确,引发空间不一致性及导航精度下降的问题,提出了一种基于不变误差定义的INS/USBL紧组合导航算法。首先,引入李群理论及左不变/右不变误差定义下的误差状态方程,保证了误差状态的空间一致性。然后,从噪声无偏性分析的角度阐述了松组合的缺陷。最后,利用超短基线测量的方位角及斜距信息,根据两种误差定义推导相应的紧组合量测方程。半实物仿真结果表明：相比于现有的INS/USBL松组合导航算法,所提出的基于右不变误差定义的紧组合导航算法有着更高的定位精度,2000 s后东向和北向定位精度分别提高14.65%和30.26%,天向定位精度提高73.91%;不变误差定义使得组合导航算法对初始对准精度的需求降低,即使初始姿态误差较大也能够对导航误差进行准确估计。