卡尔曼滤波器分类及基本公式.ppt

卡尔曼滤波器分类及基本公式.ppt

《卡尔曼滤波器分类及基本公式.ppt》由会员分享，可在线阅读，更多相关《卡尔曼滤波器分类及基本公式.ppt（39页珍藏版）》请在冰豆网上搜索。

卡尔曼卡尔曼滤波器滤波器（KalmanFilter）滤波的基本概念滤波的基本概念l滤波是什么？

滤波是什么？

所谓滤波，就是从混合在一起的诸多信号中提取出所需要的信号所谓滤波，就是从混合在一起的诸多信号中提取出所需要的信号。

l信号的分类（数学关系）？

信号的分类（数学关系）？

（11）确确定定性性信信号号：

可可以以表表示示为为确确定定的的时时间间函函数数，可可确确定定其其在在任任何何时刻的量值。

（时刻的量值。

（具有确定的频谱具有确定的频谱）（22）随随机机信信号号：

不不能能用用确确定定的的数数学学关关系系式式来来描描述述的的，不不能能预预测测其其未未来来任任何何瞬瞬时时值值，其其值值的的变变化化服服从从统统计计规规律律。

（频频谱谱不不确确定定，功功率谱确定率谱确定）滤波的基本概念滤波的基本概念l确定性信号的滤波确定性信号的滤波可采用低通、高通、带通、带阻等模拟滤波器或者计算机通可采用低通、高通、带通、带阻等模拟滤波器或者计算机通过算法实现过算法实现常规滤波常规滤波l随机信号的滤波随机信号的滤波根根据据有有用用信信号号和和干干扰扰信信号号的的功功率率谱谱设设计计滤滤波波器器维维纳纳滤滤波波（WienerFilteringWienerFiltering）或卡尔曼滤波（）或卡尔曼滤波（KalmanFilterKalmanFilter）随机信号的滤波也可以看做是随机信号的滤波也可以看做是估计问题。

估计问题。

卡尔曼滤波的由来卡尔曼滤波的由来卡尔曼滤波的由来卡尔曼滤波的由来卡尔曼，全名RudolfEmilKalman，匈牙利数学家，1930年出生于匈牙利首都布达佩斯。

1953，1954年于麻省理工学院分别获得电机工程学士及硕士学位。

1957年于哥伦比亚大学获得博士学位。

我们在现代控制理论中要学习的卡尔曼滤波器，正是源于他的博士论文和1960年发表的论文ANewApproachtoLinearFilteringandPredictionProblems（线性滤波与预测问题的新方法）。

卡尔曼滤波的由来卡尔曼滤波的由来卡尔曼滤波的由来卡尔曼滤波的由来卡尔曼滤波理论作为最优估计的一种，它的创立是科学技术和社会需要发展到一定程度的必然结果。

在1795年，高斯为测定行星测定行星运动轨道运动轨道而提出最小二乘估计法最小二乘估计法。

为了解决火力控制系统精度跟踪火力控制系统精度跟踪问题，维纳于1942年提出了维纳滤波理论维纳滤波理论，利用有用信号和干扰信号的功率谱确定线性滤波器的频率特性，首次将数理统计理论与线首次将数理统计理论与线性理论有机的联系在一起性理论有机的联系在一起，形成了对随机信号做平滑、估计或者预测的最优估计新理论。

但是采用频域设计法频域设计法是造成维纳滤波器设计困难的根本原因。

于是，人们逐渐转向寻求在时域内时域内直接设计最优滤波器的方法，而卡尔曼研究的卡尔曼滤波理论卡尔曼滤波理论很好的解决了这个问题卡尔曼滤波器是什么？

卡尔曼滤波器是什么？

卡尔曼滤波器是什么卡尔曼滤波器是什么简单的说，卡尔曼滤波器是一个“optimalrecursivedataprocessingalgorithm（最优化自回归数据处理算法最优化自回归数据处理算法）”。

从形式上，卡尔曼滤波器是55条公式条公式。

对于解决很大部分的问题，他是最优，效率最高甚至是最有用的。

他的广泛应用已经超过了30年，包括机器人机器人导航、控制，传感器数据融合导航、控制，传感器数据融合甚至在军事方面的雷达系统雷达系统以及导弹追踪导弹追踪等等。

而近年来更被应用于计算机图像处理计算机图像处理，例如头脸识别、图像分割、图像边缘检测等等。

卡尔曼滤波的特点卡尔曼滤波的特点卡尔曼滤波的特点卡尔曼滤波的特点

（1）卡尔曼滤波处理的对象是随机信号随机信号；

（2）被处理的信号无有用和干扰之分无有用和干扰之分，滤波的目的是要估计出所有被处理的信号（区别于维纳滤波）；（33）系统的白噪声激励和测量噪声并不是需要滤除的对象，它系统的白噪声激励和测量噪声并不是需要滤除的对象，它们的统计特性是估计过程中需要利用的信息们的统计特性是估计过程中需要利用的信息；（区别最小二乘）（4）算法是递推的递推的，且使用状态空间法在时域内时域内设计滤波器，适用于对多维随机过程多维随机过程的估计；（5）被估计量既可以是平稳是平稳的，也可以是非平稳是非平稳的；（6）估计过程中，只需要考虑过程噪声和测量噪声过程噪声和测量噪声及当前时刻当前时刻系统状态的统计特性系统状态的统计特性。

（计算机计算时，所占空间小）思路思路思路思路Part1Part1线性系统的卡尔曼滤波方程线性系统的卡尔曼滤波方程I.I.线性离散系统线性离散系统II.II.线性连续系统线性连续系统Part2Part2非线性系统的卡尔曼滤波方程非线性系统的卡尔曼滤波方程I.I.扩展卡尔曼滤波器扩展卡尔曼滤波器EKFEKFII.II.无迹卡尔曼滤波器无迹卡尔曼滤波器UKFUKF卡尔曼滤波的基本思想卡尔曼滤波的基本思想卡尔曼滤波的基本思想卡尔曼滤波的基本思想在海图作业中，航海长通常以前一时刻的船位为基准以前一时刻的船位为基准，根据航向、船速和海流等一系列因素推算下一个船位推算下一个船位，但是他并不轻易认为船位就一定在推算船位上，还要选择适当的方法，通过仪器得到另一个推算船位另一个推算船位。

观测和推算这两个船位一般不重合，航海长需要通过分析和判断选择一个可靠的船位选择一个可靠的船位，作为船舰当前的位置。

以以时刻的最优估计时刻的最优估计为准，预测为准，预测时刻时刻的状态变量的状态变量，同时又对该状态进行，同时又对该状态进行观测观测，得到，得到观测变量观测变量，再在预测与观测之间进行分析，或者，再在预测与观测之间进行分析，或者说是以观测量对预测量进行说是以观测量对预测量进行修正修正，从而得到，从而得到时刻的时刻的最优状态估计最优状态估计。

卡卡尔尔曼曼滤滤波波思思想想例子例子假设我们要研究一个房间的温度，以一分钟为时间单位。

根据我们的经验判断，这个房间的温度是恒定温度是恒定的，但是对我们的经验不是完全相信，可能存在上下几度的偏差，我们把该偏差看做是高斯白噪声。

另外，我们在房间里放一个温度计，温度计也不准确，测量值会与实际值存在偏差，我们也把这偏差看做是高斯白噪声。

现在，我们要根据我们的经验温度经验温度和温度计的测量值测量值及它们各自的噪声各自的噪声来估算出房间的实际温度。

卡尔曼滤波的基本方程卡尔曼滤波的基本方程例子例子假如我们要估算k时刻的实际温度值。

首先你要根据根据k-1k-1时刻时刻的温度值，来预测的温度值，来预测kk时刻的温度（时刻的温度（KK时刻的经验温度）时刻的经验温度）。

因为你相信温度是恒定的，所以你会得到k时刻的温度预测值是跟k-1时刻一样的，假设是2323度（度（*公式一）公式一），同时该值（预测（预测值）的高斯噪声的偏差是值）的高斯噪声的偏差是55度度（5是这样得到的：

如果k-1时刻估算出的最优温度值的偏差是3，你对自己预测的不确定度是4度，他们平方相加再开方，就是5（*公式二）公式二）。

然后，你从温度计那里得到了k时刻的温度值，假设是2525度度，同时该值的偏差是44度度。

卡尔曼滤波的基本方程卡尔曼滤波的基本方程例子例子卡尔曼滤波的基本方程卡尔曼滤波的基本方程现在，我们用于估算K时刻房间的实际温度有两个温度值：

估计值23度和测量值25度。

究竟实际温度是多少呢？

是相信自己还是相信温度计？

究竟相信谁多一点？

究竟相信谁多一点？

我们需要用他们的均方误差来判断。

因为，（*公式三）公式三），所以我们可以估算出估算出KK时时刻的最优温度值刻的最优温度值为：

度（*公式四）公式四）。

得到了K时刻的最优温度，下一步就是对K+1时刻的温度值进行最优估算，需要得到K时刻的最优温度（24.56）的偏差，算法如下：

（*公式五）公式五）就这样，卡尔曼滤波器就不断的把均方误差递归，从而估算出最优的温度值，运行速度快，且只保留上一时刻的协方差只保留上一时刻的协方差。

无控制无控制离散型离散型卡尔曼滤波器的基本公式卡尔曼滤波器的基本公式系统的状态方程：

系统的测量方程：

为过程噪声；为测量噪声;如果满足为过程噪声的协方差，其为非负定阵非负定阵；为测量噪声的协方差，其为正定阵正定阵。

系统测量方程的输出量是可以实际测量的量。

为噪声驱动阵11基于离散系统模型的卡尔曼滤波的基本公式基于离散系统模型的卡尔曼滤波的基本公式1.11.1无控制的离散型卡尔曼滤波基本方程无控制的离散型卡尔曼滤波基本方程无控制无控制离散型离散型卡尔曼滤波的基本方程卡尔曼滤波的基本方程

（1）状态的一步预测方程：

（2）均方误差的一步预测：

（3）滤波增益方程（权重）：

（4）滤波估计方程（K时刻的最优值）：

（5）均方误差更新矩阵（K时刻的最优均方误差）：

11基于基于离散系统模型的卡尔曼滤波的基本离散系统模型的卡尔曼滤波的基本公式公式1.11.1无控制的离散型卡尔曼滤波基本方程无控制的离散型卡尔曼滤波基本方程带有控制的离散型卡尔曼滤波基本方程带有控制的离散型卡尔曼滤波基本方程系统的状态方程：

系统的测量方程：

如果满足为过程噪声的协方差，其为非负定阵非负定阵；为测量噪声的协方差，其为正定阵正定阵。

11基于基于离散系统模型的卡尔曼滤波的基本离散系统模型的卡尔曼滤波的基本公式公式1.21.2带有控制带有控制的离散型卡尔曼滤波基本方程的离散型卡尔曼滤波基本方程

（1）状态的一步预测方程：

（2）均方误差的一步预测：

（3）滤波增益方程（权重）：

（4）滤波估计方程（K时刻的最优值）：

（5）滤波均方误差更新矩阵（K时刻的最优均方误差）：

11基于基于离散系统模型的卡尔曼滤波的基本离散系统模型的卡尔曼滤波的基本公式公式1.21.2带有控制带有控制的离散型卡尔曼滤波基本方程的离散型卡尔曼滤波基本方程带有控制的离散型卡尔曼滤波基本方程带有控制的离散型卡尔曼滤波基本方程线性离散型卡尔曼滤波方程的线性离散型卡尔曼滤波方程的一般形式一般形式系统方程和测量方程的一般形式：

如果满足为过程噪声的协方差，其为非负定阵非负定阵；为测量噪声的协方差，其为正定阵正定阵。

11基于基于离散系统模型的卡尔曼滤波的基本离散系统模型的卡尔曼滤波的基本公式公式1.31.3离散型卡尔曼滤波方程的一般形式离散型卡尔曼滤波方程的一般形式引入矩阵，对状态方程进行等效变换：

其中：

为过程噪声的协方差，其为非负定阵非负定阵；为测量噪声的协方差，其为正定阵正定阵。

11基于基于离散系统模型的卡尔曼滤波的基本离散系统模型的卡尔曼滤波的基本公式公式1.31.3离散型卡尔曼滤波方程的一般形式离散型卡尔曼滤波方程的一般形式一般形式的卡尔曼滤波方程一般形式的卡尔曼滤波方程

（1）状态的一步预测方程：

（2）均方误差的一步预测：

（3）滤波增益方程（权重）：

（4）滤波估计方程（K时刻的最优值）：

（5）滤波均方误差更新矩阵（K时刻的最优均方误差）：

11基于基于离散系统模型的卡尔曼滤波的基本离散系统模型的卡尔曼滤波的基本公式公式1.31.3离散型卡尔曼滤波方程的一般形式离散型卡尔曼滤波方程的一般形式离散型卡尔曼滤波基本方程使用要点离散型卡尔曼滤波基本方程使用要点

（1）滤波初值的选取滤波初值的选取卡尔曼滤波是一种递推算法，启动时必须先给初值情况一：

一般情况下，取，卡尔曼滤波器是无偏的，即滤波稳定滤波稳定，但是实际上这样的初值很难得到；情况二：

如果系统是一致完全随机可控和一致完全随机可观测的，则卡尔曼滤波器一定是一致渐近稳定的，此时盲目的选取滤波初值不影响最终估计值（大多数情况下）。

11基于离散系统模型的卡尔曼滤波的基本公式基于离散系统模型的卡尔曼滤波的基本公式1.41.4离散型卡尔曼滤波基本方程使用要点离散型卡尔曼滤波基本方程使用要点离散型卡尔曼滤波基本方程使用要点离散型卡尔曼滤波基本方程使用要点

（2）估计均方误差的等价形式及选用