从高斯-牛顿迭代的角度对迭代扩展卡尔曼滤波(IEKF)进行分析,提出了一种基于组合牛顿迭代法的改进IEKF算法。该算法通过实时判断每次迭代对状态的逼近程度,采用加权平均的方法确定新的迭代值,继而采用卡尔曼滤波框架对状态进行量测更新。新算法较传统的IEKF具有精度高以及对初值不敏感的优点。实例仿真验证了该算法的有效性。
By analyzing iterated extended Kalman filter(IEKF) in terms of Gauss-Newton iteration,a modified IEKF algorithm was obtained with the globally convergent hybrid Newton′s method.This algorithm was used to determine the new iterated value by means of weighted average as well as real-time judgment of each iteration approaching to the actual state.And then,the Kalman filtering framework was used for the new iterated value to update the state vector.Compared with the conventional IEKF,this algorithm is advantageous to accuracy and robustness.The simulation results prove that the algorithm is effective.