一种基于超短基线和航位推算的水下导航定位方法
摘要:
本发明涉及一种基于超短基线和航位推算的水下导航定位方法,包括以下步骤:S1、确定超短基线系统的定位原理;S2、确定超短基线系统的误差模型;S3、建立状态模型和观测模型;S4、建立考虑方向角量测偏差变化的扩展卡尔曼滤波算法。本发明能有效地适应方向角量测噪声变化的情形,在小方向角下也能保持较高的定位精度。
0/0