平缓地磁场区域地磁导航解决方案

摘要

针对基于卡尔曼滤波的地磁场导航方法在平缓地磁场区域因系统不可观导致滤波失效问题,提出了解决方案.该方案用线性化平面拟合平缓磁场曲面,用磁场的矢量性构造线性方程组,用多级子图实现快速精准的位置估计,并在此基础上构造滤波器.理论分析和仿真结果证明,该方案可有效解决传统方法的滤波发散问题.