卡尔曼滤波器原理详细推导

原创

已于 2023-10-09 11:00:35 修改 · 961 阅读

·

1

·

CC 4.0 BY-SA版权

版权声明：本文为博主原创文章，遵循 CC 4.0 BY-SA 版权协议，转载请附上原文出处链接和本声明。

文章标签：

#算法 #学习

于 2022-08-07 11:13:35 首次发布

本文详细阐述了卡尔曼滤波器的三个关键步骤：计算卡尔曼增益、状态变量估计与误差更新。通过状态空间方程，解释了如何处理过程噪声和测量噪声，并介绍了如何利用先验估计值和测量估计值进行数据融合，最终求得后验估计值和误差协方差的最小化。

Kalman滤波器的设计可以分为三步：

Step1：计算卡尔曼增益（Kalman Gain）

$K_{k}=\frac{e_{k-1(EST)}}{e_{k-1(EST)}+e_{k(MEA))}}$

$e_{k-1(EST)}$ 为k-1时刻的估计误差， $e_{k(MEA))}$ 为k时刻的测量误差。

Step2：计算k时刻的状态变量估计值

$\hat{x}_{k}=\hat{x}_{k-1}+K_{k}(z_{k}-\hat{x}_{k-1})$

$z_{k}$ 为k时刻测量值。

Step3：更新k时刻的估计误差

$e_{k(EST)}=(1-K_{k})e_{k-1(EST)}$

具体原理及详细推导：

首先给出状态空间方程（离散形式）

$\left\{\begin{matrix} x_{k}=Ax_{k-1}+Bu_{k-1}+\omega_{k-1} \\ z_{k}=Hx_{k}+\upsilon _{k} \end{matrix}\right.$

其中 $\omega$ 为过程噪声， $\upsilon$ 为测量噪声，且满足正态分布

$P(\omega )\sim (0,Q)\; \; \; \; \; P(\upsilon )\sim (0,R)$

Q、R为协方差矩阵且

$Q=E[\omega \omega ^{T}]\; \; \; \; \; R=E[\upsilon \upsilon ^{T}]$

补充：

$Var(x)=E(x^{2})-E^{2}(x)\; \; \; \; \; Cov(x,y)=E(xy)-E(x)E(y)$

假设

$x_{k}=\begin{bmatrix} x_{1}\\ x_{2} \end{bmatrix}$ ，

则

最低0.47元/天解锁文章

评论

被折叠的条评论为什么被折叠?

到【灌水乐园】发言

查看更多评论

添加红包

成就一亿技术人!

hope_wisdom

发出的红包

实付元

使用余额支付

点击重新获取

扫码支付

钱包余额 0

抵扣说明：

1.余额是钱包充值的虚拟货币，按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载，可以购买VIP、付费专栏及课程。