论文部分内容阅读
为了提高GPS/DR组合导航定位的精度和稳定性,提出一种基于插值公式的EKF(扩展卡尔曼滤波)改进算法。插值滤波算法继承了EKF实时递推结构,利用基于Stirling插值公式的差分方法代替EKF中非线性函数导数的计算。将插值公式展开的一阶项和二阶项作为函数近似分别得到DD1、DD2(一阶、二阶差分)滤波算法。插值滤波不必计算函数稚可比矩阵,大大降低了计算的复杂度,并改善了EKF算法中泰勒展开线性化造成的较大误差。根据GPS/DR组合系统的状态和观测方程,采用EKF、DD1和DD2滤波算法分别估计目标