三应答器SINS/USBL紧耦合导航算法

SINS/USBL组合导航误差因素主要包括USBL测距精度误差、USBL测角误差、USBL到SINS的安装误差以及应答器的位置误差,且现有USBL设备的普遍特点为:测距精度高而测角精度相对较差。针对上述误差因素和特点,提出一种三应答器SINS/USBL紧耦合导航算法,避免了USBL测角误差以及USBL到SINS的安装角误差等对导航精度的影响,仿真结果表明能够较大程度上提高组合导航定位精度。此外,该算法无需对安装角进行标定,使用更加便捷。