卡尔曼滤波——迭代过程

来源:互联网 发布:学汉语软件 编辑:程序博客网 时间:2024/06/17 16:22

之前提到了IMU与视觉SLAM的融合,因此也避不开卡尔曼滤波的使用。作为最经典的算法之一,推导过程不再赘述,这里只简述一下迭代的公式。

  1. 计算预测值,预测值和真实值之间的误差协方差矩阵
    这里写图片描述

  2. 有了上式可以计算卡尔曼增益K,然后得到估计值
    这里写图片描述

  3. 计算估计值和真实值之间的误差协方差矩阵,为下一次迭代做准备
    这里写图片描述

其中:A为状态转移矩阵,Q为系统噪声方差矩阵,R为观测噪声方差矩阵

原创粉丝点击