一种基于多点地形匹配定位的AUV航迹偏差估计方法

摘要

本发明提供的是一种基于多点地形匹配定位的AUV航迹偏差估计方法。(1)地形匹配定位的搜索区间估计；(2)未知潮差和测量误差情况下的地形匹配定位；(3)测量误差估计和定位置信区间估计；(4)定位误差估计；(5)多点地形匹配定位初航迹偏差估计；(6)航迹关联与误定位点剔除；(7)航迹二次拟合。本发明的优点是结合了推算导航在时域和空域都缓慢变化而地形匹配定位结果在时域和空域不具有扩散性的特点，在航迹线上获得多个密集的地形匹配定位点，多点的定位信息拟合推算导航的航迹线从而使得定位的精度和可靠性大幅增加。