姓名:周峰 学号1411082695
摘要：Kalman Filter是一个高效的递归滤波器，它可以实现从一系列的噪声测量中，估计动态系统的状态。广泛应用于包含Radar、计算机视觉在内的等工程应用领域，在控制理论和控制系统工程中也是一个非常重要的课题。本文介绍了卡尔曼滤波增益的由来，以及它在卡尔曼滤波理论中的作用，着重介绍了卡尔曼滤波增益的理论意义和它的物理意义。由卡尔曼滤波增益可以更深入的理解卡尔曼滤波，把它更好地应用于实际中。测井技术
Abstract:胆汁酸Kalman Filter is an efficient recursive filter,it can achieve the task that estimates the dynamic state of the system from a series of noise measurements.It widely be used in Radar, computer vision, include other engineering applications, is also a very important issue in control theory and control systems engineering.This paper introduces the origin of the Kalman filter gain,and it plays the important role in the Kalman filter theory,especially focuses on its the theoretical meaning and physical meaning about Kalman filter gain . We will get a deeper understanding of the Kalman filter,better applied in practice by learning of t
he Kalman filter gain.
关键词：卡尔曼滤波 增益 误差
一、卡尔曼滤波器简介
1.1卡尔曼滤波的由来
1960年卡尔曼发表了用递归方法解决离散数据线性滤波问题的论文-《A New Approach to Linear Filtering and Prediction Problems》（线性滤波与预测问题的新方法），在这篇文章里一种克服了维纳滤波缺点的新方法被提出来，这就是我们今天称之为卡尔曼滤波的方法。卡尔曼滤波应用广泛且功能强大，它可以估计信号的过去和当前状态甚至能估计将来的状态即使并不知道模型的确切性质。
其基本思想是以最小均方误差为最佳估计准则，采用信号与噪声的状态空间模型利用前一时刻的估计值和当前时刻的观测值来更新对状态变量的估计，求出当前时刻的估计值。算法根据建立的系统方程和观测方程对需要处理的信号做出满足最小均方误差的估计。
对于解决很大部分的问题，它是最优，效率最高甚至是最有用的。它的广泛应用已经超过30年，包括机器人导航，控制，传感器数据融合甚至在军事方面的雷达系统以及导弹追踪等等。近年来更被应用于计算机图像处理，例如头脸识别，图像分割，图像边缘检测等等。
1.2卡尔曼滤波原理
卡尔曼滤波器用于估计离散时间过程的状态变量 。 这个离散时间过程由以下离散随机差分方程描述：
公式1.1
定义观测变量，的量测方程：
公式1.2
随机信号和分别表示过程激励噪声和观测噪声。假设它们为相互独立，正态分布的白噪声：
p(w) ∼ N(0, Q), 公式1.3
p(v) ∼ N(0, R). 公式1.4
实际系统中， 过程激励噪声协方差矩阵 Q 和观测噪声协方差矩阵 R 可 能会随每次迭代计算而变化。但在这儿我们假设它们是常数。
当控制函数 或过程激励噪声为零时，差分方程1.1中的 n × n阶增益矩阵 A 将上一时刻 k − 1 的状态线性映射到当前时刻 k 的状态。实际中 A 可能随时间变化，但在这儿假设为常数。 n × l阶矩阵 B 代表可选的控制输入 的增益。量测方程1.2中的 m × n 阶矩阵 H 表示状态变量 对测量变量的增益。实际中 H 可能随时间变化，但在这儿假设为常数。
齐鲁周刊
定义 （ − 代表先验， ˆ代表估计）为在已知第 k 步以前状态情况下第 k 步的先验状态估计。定义 为已知测量变量 时第 k 步的后验状态估计。由此定义先验估计误差和后验估计误差：
PINGCO
先验估计误差的协方差为：
公式1.5
后验估计的协方差：
公式1.6
式1.7构造了卡尔曼滤波器的表达式： 先验估计 和加权的测量变量
及其预测 H之差的线性组合构成了后验状态估计 。
公式1.7
式1.7中测量变量及其预测之差 被称为测量过程的革新或残余。残余反映了预测值和实际值之间的不一致程度。残余为零表明二者完全吻合。式1.7中 n × m 阶矩阵 K 叫做残余的增益或混合因数，作用是使1.6式中的后验估计误差协方差最小。可以通过以下步骤计算 K ：首先将1.7式代入的定义式，再将代入1.6式中，求得期望后，将1.6式中的 对K 求导。并使一阶导数为零从而解得 K 值。K的一种表示形式为：
公式1.8
二、卡尔曼滤波增益
2.1推导后验协方差矩阵
按照定义，我们从误差协方差开始推导如下：
代入
再带入
整理测量误差向量，得：
因为噪声项与其他项不相关，协方差=0，所以有：
利用协方差矩阵性质，提出常数矩阵，得：
如果记 ，则有：
2.1
2.2推导最优卡尔曼增益
最优化K：使后验估计的协方差达到最小。（换一个概念）也是使向量的二范数的数学期望值最小化的一个过程。这等同于后验估计的协方差矩阵的迹最小化
记：
2.1可以写成
2.2
把 对求导，并令导数=0，则可以得到 取最小值时的最优化的值。
解得：
化简后验误差协方差公式。在卡尔曼增益等于上面导出的最优值时，计算后验协方差的公式可以进行简化。对于卡尔曼增益公式
在卡尔曼增益公式两侧同时右乘得：
把上式带入2.2式，可以消去后面的两项，得：
整理，得：
这个公式的计算比较简单，所以实际中总是使用这个公式，但是需注意这公式仅在使用最优卡尔曼增益的时候它才成立。如果算术精度总是很低而导致数值稳定性出现问题，或者特意使用非最优卡尔曼增益，那么就不能使用这个简化；必须使用2.2式表示的后验误差协方差公式。
2.3卡尔曼增益的物理意义
其中：H矩阵为常量；与过程激励噪声的协方差矩阵Q有关；R为测量噪声的协方差矩阵。取值范围： 。
环氧环己烷
当 R 趋向于零时，有：
当 趋向于零时，有：
意义：决定了最优估计组成比例的“调节器”。
当 R 趋向于零时，有：
豫公网安备41160202000603
站长QQ:729038198
关于我们
投诉建议