基于格网拓扑结构迭代最佳环域点提高水下导航精度方法

摘要

本发明公开了一种基于格网拓扑结构迭代最佳环域点提高水下导航精度方法，包括：通过航迹起点小环域格网匹配定位策略，得到水下潜器航迹起点的最佳匹配位置；根据水下潜器航迹起点的最佳匹配位置，通过航迹终点变角度三层环域匹配定位策略，生成大环域待匹配格网点；迭代计算大环域待匹配格网点的匹配效能评价指标，并按最优原则获得大环域范围内水下潜器航迹终点的最佳匹配位置，以实现水下潜器航迹终点的有效匹配定位，进而修正INS系统控制参数并辅助完成水下潜器长航时长航距的航行目标。通过本发明所述的方法，提高了水下潜器重力辅助导航的匹配精度。