基于仿射参数估计的地磁匹配导航算法

针对地磁匹配导航技术中匹配精度和算法耗时相互制约的问题,本文提出一种基于仿射参数估计的地磁匹配导航算法,在保证匹配精度的同时有效提高了算法的实时性。综合考虑惯导系统的初始位置误差、初始航向误差和初始速度误差,建立参考轨迹的仿射模型;用泰勒公式将地磁匹配问题转化为仿射模型的参数估计问题;通过Broyden迭代计算实现匹配问题的求解。试验结果表明:采用基于仿射参数估计的地磁匹配导航算法,匹配定位精度为37.97 m,算法耗时为20.7 ms,因此提出的算法能够有效提高匹配定位精度和实时性。