[发明专利]一种基于误差控制的卡尔曼滤波自适应滤波算法

摘要

本发明公开了一种基于误差控制的卡尔曼滤波自适应滤波算法，考虑到初始滤波计算过程及系统状态突变的场景下，由于观测误差过大，造成滤波结果不稳定的情况，在自适应卡尔曼滤波算法的基础上，基于观测误差的协方差矩阵，设计一个自适应抑制因子，再利用该自适应抑制因子构建观测误差协方差矩阵的自适应修正模型，最后结合卡尔曼滤波算法的预测及更新模型，利用当前时刻系统状态的测量值和预测值，得到系统当前时刻较为精确的最终状态。本发明通过设计自适应抑制因子对系统进行误差控制，降低了观测误差对于卡尔曼增益的影响，提升了基于滤波算法估计系统状态结果的稳定性。