基于仿射模型变换的地磁匹配导航算法

为了提高潜航器上地磁匹配的效率和精度,通过对潜航器惯导系统误差模型的分析,提出了一种基于仿射模型变换的粗精两级地磁匹配定位方法。首先,利用基于等值线约束的相关匹配算法消除导航系统的初始位置误差;其次,采用仿射模型对相关匹配结果的轨迹进行旋转、缩放变换,通过参数扫描实现精匹配的过程。该算法在保证实时性的同时,匹配精度优于1个网格点。