卡尔曼滤波器分类及基本公式共40张幻灯片.ppt
- 【下载声明】
1. 本站全部试题类文档,若标题没写含答案,则无答案;标题注明含答案的文档,主观题也可能无答案。请谨慎下单,一旦售出,不予退换。
2. 本站全部PPT文档均不含视频和音频,PPT中出现的音频或视频标识(或文字)仅表示流程,实际无音频或视频文件。请谨慎下单,一旦售出,不予退换。
3. 本页资料《卡尔曼滤波器分类及基本公式共40张幻灯片.ppt》由用户(三亚风情)主动上传,其收益全归该用户。163文库仅提供信息存储空间,仅对该用户上传内容的表现方式做保护处理,对上传内容本身不做任何修改或编辑。 若此文所含内容侵犯了您的版权或隐私,请立即通知163文库(点击联系客服),我们立即给予删除!
4. 请根据预览情况,自愿下载本文。本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。
5. 本站所有资源如无特殊说明,都需要本地电脑安装OFFICE2007及以上版本和PDF阅读器,压缩文件请下载最新的WinRAR软件解压。
- 配套讲稿:
如PPT文件的首页显示word图标,表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制:
部分文档作品中含有的国旗、国徽等图片,仅作为作品整体效果示例展示,禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词:
- 卡尔 滤波器 分类 基本 公式 40 幻灯片
- 资源描述:
-
1、卡尔曼卡尔曼 滤波器滤波器(Kalman Filter)滤波的基本概念滤波的基本概念l滤波是什么?滤波是什么?所谓滤波,就是从混合在一起的诸多信号中提取出所需要的信号所谓滤波,就是从混合在一起的诸多信号中提取出所需要的信号。l信号的分类(数学关系)?信号的分类(数学关系)?(1 1)确定性信号:可以表示为确定的时间函数,可确定其在任何)确定性信号:可以表示为确定的时间函数,可确定其在任何时刻的量值。(时刻的量值。(具有确定的频谱具有确定的频谱)(2 2)随机信号:不能用确定的数学关系式来描述的,不能预测其)随机信号:不能用确定的数学关系式来描述的,不能预测其未来任何瞬时值,其值的变化服从统计规
2、律。(未来任何瞬时值,其值的变化服从统计规律。(频谱不确定,频谱不确定,功功率谱确定率谱确定)滤波的基本概念滤波的基本概念l确定性信号的滤波确定性信号的滤波可采用低通、高通、带通、带阻等模拟滤波器或者计算机通可采用低通、高通、带通、带阻等模拟滤波器或者计算机通过算法实现过算法实现常规滤波常规滤波l随机信号的滤波随机信号的滤波根据有用信号和干扰信号的功率谱设计滤波器根据有用信号和干扰信号的功率谱设计滤波器维纳滤波维纳滤波(Wiener FilteringWiener Filtering)或卡尔曼滤波()或卡尔曼滤波(Kalman FilterKalman Filter)随机信号的滤波也可以看做是
3、随机信号的滤波也可以看做是估计问题。估计问题。卡尔曼滤波的由来卡尔曼滤波的由来卡尔曼滤波的由来卡尔曼滤波的由来卡尔曼,全名Rudolf Emil Kalman,匈牙利数学家,1930年出生于匈牙利首都布达佩斯。1953,1954年于麻省理工学院分别获得电机工程学士及硕士学位。1957年于哥伦比亚大学获得博士学位。我们在现代控制理论中要学习的卡尔曼滤波器,正是源于他的博士论文和1960年发表的论文A New Approach to Linear Filtering and Prediction Problems(线性滤波与预测问题的新方法)。卡尔曼滤波的由来卡尔曼滤波的由来卡尔曼滤波的由来卡尔曼
4、滤波的由来 卡尔曼滤波理论作为最优估计的一种,它的创立是科学技术和社会需要发展到一定程度的必然结果。在1795年,高斯为测定行星测定行星运动轨道运动轨道而提出最小二乘估计法最小二乘估计法。为了解决火力控制系统精度跟踪火力控制系统精度跟踪问题,维纳于1942年提出了维纳滤波理论维纳滤波理论,利用有用信号和干扰信号的功率谱确定线性滤波器的频率特性,首次将数理统计理论与线首次将数理统计理论与线性理论有机的联系在一起性理论有机的联系在一起,形成了对随机信号做平滑、估计或者预测的最优估计新理论。但是采用频域设计法频域设计法是造成维纳滤波器设计困难的根本原因。于是,人们逐渐转向寻求在时域内时域内直接设计最
5、优滤波器的方法,而卡尔曼研究的卡尔曼滤波理论卡尔曼滤波理论很好的解决了这个问题卡尔曼滤波器是什么?卡尔曼滤波器是什么?卡尔曼滤波器是什么卡尔曼滤波器是什么 简单的说,卡尔曼滤波器是一个“optimal recursive data processing algorithm(最优化自回归数据处理算法最优化自回归数据处理算法)”。从形式上,卡尔曼滤波器是5 5条公式条公式。对于解决很大部分的问题,他是最优,效率最高甚至是最有用的。他的广泛应用已经超过了30年,包括机器人机器人导航、控制,传感器数据融合导航、控制,传感器数据融合甚至在军事方面的雷达系统雷达系统以及导弹追踪导弹追踪等等。而近年来更被应
6、用于计算机图像处理计算机图像处理,例如头脸识别、图像分割、图像边缘检测等等。卡尔曼滤波的特点卡尔曼滤波的特点卡尔曼滤波的特点卡尔曼滤波的特点(1)卡尔曼滤波处理的对象是随机信号随机信号;(2)被处理的信号无有用和干扰之分无有用和干扰之分,滤波的目的是要估计出所有被处理的信号(区别于维纳滤波);(3 3)系统的白噪声激励和测量噪声并不是需要滤除的对象,它系统的白噪声激励和测量噪声并不是需要滤除的对象,它们的统计特性是估计过程中需要利用的信息们的统计特性是估计过程中需要利用的信息;(区别最小二乘)(4)算法是递推的递推的,且使用状态空间法在时域内时域内设计滤波器,适用于对多维随机过程多维随机过程的
7、估计;(5)被估计量既可以是平稳是平稳的,也可以是非平稳是非平稳的;(6)估计过程中,只需要考虑过程噪声和测量噪声过程噪声和测量噪声及当前时刻当前时刻系统状态的统计特性系统状态的统计特性。(计算机计算时,所占空间小)思路思路思路思路Part 1 Part 1 线性系统的卡尔曼滤波方程线性系统的卡尔曼滤波方程线性离散系统线性离散系统线性连续系统线性连续系统Part 2 Part 2 非线性系统的卡尔曼滤波方程非线性系统的卡尔曼滤波方程扩展卡尔曼滤波器扩展卡尔曼滤波器 EKFEKF无迹卡尔曼滤波器无迹卡尔曼滤波器 UKFUKF卡尔曼滤波的基本思想卡尔曼滤波的基本思想卡尔曼滤波的基本思想卡尔曼滤波的
8、基本思想 在海图作业中,航海长通常以前一时刻的船位为基准以前一时刻的船位为基准,根据航向、船速和海流等一系列因素推算下一个船位推算下一个船位,但是他并不轻易认为船位就一定在推算船位上,还要选择适当的方法,通过仪器得到另一个推算船位另一个推算船位。观测和推算这两个船位一般不重合,航海长需要通过分析和判断选择一个可靠的船位选择一个可靠的船位,作为船舰当前的位置。以以 时刻的最优估计时刻的最优估计 为准,预测为准,预测 时刻时刻的状态变量的状态变量 ,同时又对该状态进行,同时又对该状态进行观测观测,得到,得到观测变量观测变量 ,再在预测与观测之间进行分析,或者,再在预测与观测之间进行分析,或者说是以
9、观测量对预测量进行说是以观测量对预测量进行修正修正,从而得到,从而得到 时刻的时刻的最优状态估计最优状态估计 。1kx1K/1k kxkzkxKK卡卡尔尔曼曼滤滤波波思思想想例子例子假设我们要研究一个房间的温度,以一分钟为时间单位。根据我们的经验判断,这个房间的温度是恒定温度是恒定的,但是对我们的经验不是完全相信,可能存在上下几度的偏差,我们把该偏差看做是高斯白噪声。另外,我们在房间里放一个温度计,温度计也不准确,测量值会与实际值存在偏差,我们也把这偏差看做是高斯白噪声。现在,我们要根据我们的经验温度经验温度和温度计的测量值测量值及它们各自的噪声各自的噪声来估算出房间的实际温度。卡尔曼滤波的基
10、本方程卡尔曼滤波的基本方程例子例子假如我们要估算 k 时刻的实际温度值。首先你要根据根据 k-1 k-1 时刻时刻的温度值,来预测的温度值,来预测 k k 时刻的温度(时刻的温度(K K时刻的经验温度)时刻的经验温度)。因为你相信温度是恒定的,所以你会得到 k 时刻的温度预测值是跟 k-1 时刻一样的,假设是 23 23 度(度(*公式一)公式一),同时该值(预测(预测值)的高斯噪声的偏差是值)的高斯噪声的偏差是 5 5 度度(5 是这样得到的:如果 k-1 时刻估算出的最优温度值的偏差是 3,你对自己预测的不确定度是 4 度,他们平方相加再开方,就是 5(*公式二)公式二)。然后,你从温度计
11、那里得到了 k时刻的温度值,假设是25 25 度度,同时该值的偏差是 4 4 度度。卡尔曼滤波的基本方程卡尔曼滤波的基本方程例子例子卡尔曼滤波的基本方程卡尔曼滤波的基本方程现在,我们用于估算K时刻房间的实际温度有两个温度值:估计值23度和测量值25度。究竟实际温度是多少呢?是相信自己还是相信温度计?究竟相信谁多一点?究竟相信谁多一点?我们需要用他们的均方误差来判断。因为,(*公式三)公式三),所以我们可以估算出估算出K K时时刻的最优温度值刻的最优温度值为:度(*公式四)公式四)。得到了K时刻的最优温度,下一步就是对K+1时刻的温度值进行最优估算,需要得到K时刻的最优温度(24.56)的偏差,
12、算法如下:(*公式五)公式五)就这样,卡尔曼滤波器就不断的把均方误差递归,从而估算出最优的温度值,运行速度快,且只保留上一时刻的协方差只保留上一时刻的协方差。222250.7854HH230.78*(2523)24.5621*52.35H无控制无控制离散型离散型卡尔曼滤波器的基本公式卡尔曼滤波器的基本公式系统的状态方程:系统的测量方程:,1111k kkx kx kw k kZ kCx kv k1w k v k为过程噪声;为测量噪声;如果1w k v k0,;0,;,0kkjkkjkkjkkjkjE wCov w wQE VCov V VRCov W V满足为过程噪声的协方差,其为非负定阵非负
13、定阵;为测量噪声的协方差,其为正定阵正定阵。kQkR系统测量方程的输出量 Z k是可以实际测量的量。为噪声驱动阵1 1 基于离散系统模型的卡尔曼滤波的基本公式基于离散系统模型的卡尔曼滤波的基本公式1.1 1.1 无控制的离散型卡尔曼滤波基本方程无控制的离散型卡尔曼滤波基本方程无控制无控制离散型离散型卡尔曼滤波的基本方程卡尔曼滤波的基本方程/1,11k kk kkxx/1,11,1111TTk kk kkk kkkkPPQ1/1/1TTkk kkkk kkkHPCCPCR/1/1kk kkkkk kxxHZCx/1kkkk kPIHCP(1)状态的一步预测方程:(2)均方误差的一步预测:(3)滤
14、波增益方程(权重):(4)滤波估计方程(K时刻的最优值):(5)均方误差更新矩阵(K时刻的最优均方误差):1 1 基于离散系统模型的卡尔曼滤波的基本公式基于离散系统模型的卡尔曼滤波的基本公式1.1 1.1 无控制的离散型卡尔曼滤波基本方程无控制的离散型卡尔曼滤波基本方程 带有控制的离散型卡尔曼滤波基本方程带有控制的离散型卡尔曼滤波基本方程系统的状态方程:系统的测量方程:,111111kk kkkkkkxxwBu kZ kC x kv k如果1w k v k0,;0,;,0kkjkkjkkjkkjkjE WCov W WQE VCov V VRCov W V满足为过程噪声的协方差,其为非负定阵非
15、负定阵;为测量噪声的协方差,其为正定阵正定阵。kQkR1 1 基于离散系统模型的卡尔曼滤波的基本公式基于离散系统模型的卡尔曼滤波的基本公式1.2 1.2 带有控制的离散型卡尔曼滤波基本方程带有控制的离散型卡尔曼滤波基本方程 /1,1111k kk kkkkxxBu/1,11,1111TTk kk kkk kkkkPPQ1/1/1TTkk kkkk kkkHPCCPCR/1/111kk kkkkk kkkkxxHZCxC Bu/1kkkk kPIHCP(1)状态的一步预测方程:(2)均方误差的一步预测:(3)滤波增益方程(权重):(4)滤波估计方程(K时刻的最优值):(5)滤波均方误差更新矩阵(
16、K时刻的最优均方误差):1 1 基于离散系统模型的卡尔曼滤波的基本公式基于离散系统模型的卡尔曼滤波的基本公式1.2 1.2 带有控制的离散型卡尔曼滤波基本方程带有控制的离散型卡尔曼滤波基本方程 带有控制的离散型卡尔曼滤波基本方程带有控制的离散型卡尔曼滤波基本方程线性离散型卡尔曼滤波方程的线性离散型卡尔曼滤波方程的一般形式一般形式系统方程和测量方程的一般形式:,111111kk kkkkkkkkkkxxBuwZC xv 0,;0,;,kkjkkjkkjkkjkjkkjE wCov w wQE vCov v vRCov w vS如果1kwkv满足为过程噪声的协方差,其为非负定阵非负定阵;为测量噪声
17、的协方差,其为正定阵正定阵。kQkR1 1 基于离散系统模型的卡尔曼滤波的基本公式基于离散系统模型的卡尔曼滤波的基本公式1.3 1.3 离散型卡尔曼滤波方程的一般形式离散型卡尔曼滤波方程的一般形式 *,1111111;kk kkkkkkkkkkkxxBuJZwZC xv*,1,11111111;k kk kkkkkkkkJCwwJv 引入矩阵 ,对状态方程进行等效变换:1kkkkJS R 其中:*0,;0,;,0kkjkkjkkjkkjkjE wCov w wQE vCov v vRCov w v为过程噪声的协方差,其为非负定阵非负定阵;为测量噪声的协方差,其为正定阵正定阵。kQkR1 1 基
展开阅读全文