- 1、本文档共25页,可阅读全部内容。
- 2、有哪些信誉好的足球投注网站(book118)网站文档一经付费(服务费),不意味着购买了该文档的版权,仅供个人/单位学习、研究之用,不得用于商业用途,未经授权,严禁复制、发行、汇编、翻译或者网络传播等,侵权必究。
- 3、本站所有内容均由合作方或网友上传,本站不对文档的完整性、权威性及其观点立场正确性做任何保证或承诺!文档内容仅供研究参考,付费前请自行鉴别。如您付费,意味着您自己接受本站规则且自行承担风险,本站不退款、不进行额外附加服务;查看《如何避免下载的几个坑》。如果您已付费下载过本站文档,您可以点击 这里二次下载。
- 4、如文档侵犯商业秘密、侵犯著作权、侵犯人身权等,请点击“版权申诉”(推荐),也可以打举报电话:400-050-0827(电话支持时间:9:00-18:30)。
- 5、该文档为VIP文档,如果想要下载,成为VIP会员后,下载免费。
- 6、成为VIP后,下载本文档将扣除1次下载权益。下载后,不支持退款、换文档。如有疑问请联系我们。
- 7、成为VIP后,您将拥有八大权益,权益包括:VIP文档下载权益、阅读免打扰、文档格式转换、高级专利检索、专属身份标志、高级客服、多端互通、版权登记。
- 8、VIP文档为合作方或网友上传,每下载1次, 网站将根据用户上传文档的质量评分、类型等,对文档贡献者给予高额补贴、流量扶持。如果你也想贡献VIP文档。上传文档
卡尔曼滤波器原理林斌P201109026
内容提纲发展概述算法前提算法推导算法总结5算法扩展卡尔曼滤波
发展概述工程背景:1960s航空航天工程突飞猛进电子计算机又方兴未艾Rudolf(Rudy)EmilKálmán正式提出:(1930~)《一种关于线性过滤和预测难题的新方法》1960Anewapproachtolinearfilteringandpredictionproblems,1960卡尔曼滤波
发展概述优势:1、采用物理意义较为直观的时域状态空间2、仅需要前后两步的数据,数据存储量较小3、使用比较简单的递推算法,便于在计算机上实现4、不仅适用于平稳过程,还可以推广到非平稳随机过程的情况发展:卡尔曼滤波器已成为推广研究和应用的主题,尤其是在自主或协助导航领域。卡尔曼滤波
算法前提随机离散系统模型定义随机离散时间过程的状态向量程由以下离散随机差分方程描述:,该过nx1nxnnxnnx1nx1假设系统满足可观性要求,定义观测向量得到观测方程:,mx1mxnmx1随机信号和分别表示过程激励噪声和观测噪声,并假设它们是相互独立并满足正态分布的白噪声。卡尔曼滤波
算法前提即有:过程激励噪声观测噪声实际过程中过程激励噪声协方差矩阵Q和观测噪声协方差矩阵R可能随着每次迭代计算而变化,但在这里我们假设它们为常数。另外,状态转移矩阵A,输入矩阵B和测量方程2.2中的矩阵H,在实际过程中都可能随时间变化而变化,但在这儿假设为常数。卡尔曼滤波
算法前提先验估计和后验估计,及其误差定义为根据上一次迭代计算结果而产生的估计值,称为先验估计。定义为根据当前计算结果而产生的估计值,称为后验估计。定义先验估计误差为定义后验估计误差为nx1nx1真值真值卡尔曼滤波
算法前提定义先验估计误差的协方差为定义后验估计误差的协方差为卡尔曼滤波
算法推导目的描述:在系统结构已知的情况下,给定k时刻的状态观测向量,求k时刻的系统状态向量的最优估计,使得最小。基本思路:1、根据计算出k时刻的先验估计同时也产生了先验估计的协方差矩阵式的递推公卡尔曼滤波
算法推导2、根据先验估计计算出k时刻的观测向量的估计3、计算实测值与估计的差,以此来修正之前的先验估计,得到后验估计把带入:里的重系数也成卡曼权重残差至此卡曼波算原型公式基,下面要确定出最系数K和在最系数下的后估差的方差推方法卡尔曼滤波
算法推导推导后验协方差矩阵按照定义,我们从误差协方差开始推导如下:带入再带入卡尔曼滤波
算法推导整理测量误差向量,得:因为噪声项与其他项不相关,协方差=0,所以有:利用协方差矩阵性质,提出常数矩阵,得:卡尔曼滤波
算法推导如果记,则有:卡尔曼滤波
算法推导推导最优卡尔曼增益最优化K:使后验估计的协方差达到最小。(换一个概念)也是使向量的二范数的数学期望值最小化的一个过程。这等同于后验估计的协方差矩阵的迹最小化卡尔曼滤波
算法推导首先展开3.4式,得:记:上面的式子可以写为:卡尔曼滤波
算法推导把对求导,并令导数=0,则可以得到取最小值时的最优化的值。引入常用数学公式??解得:卡尔曼滤波
算法推导化简后验误差协方差公式在卡尔曼增益等于上面导出的最优值时,计算后验协方差的公式可以进行简化。对于卡尔曼增益公式在卡尔曼增益公式两侧同时右乘得:把上式带入3.5式,可以消去后面的两项,得:卡尔曼滤波
算法推导整理,得:这个公式的计算比较简单,所以实际中总是使用这个公式,但是需注意这公式仅在使用最优卡尔曼增益的时候它才成立。如果算术精度总是很低而导致数值稳定性出现问题,或者特意使用非最优卡尔曼增益,那么就不能使用这个简化;必须使用3.5式表示的后验误差协方差公式。
算法推导卡尔曼增益的物理意义其中:H矩阵为常量;与过程激励噪声的协方差矩阵Q有关;R为测量噪声的协方差矩阵。取值范围:当R趋向于零时,有:当趋向于零时,有:卡尔曼滤波
算法推导意义:决定了最优估计组成比例的“调节器”当R趋向于零时,有:测量噪声V=0mx1此时3.3式改为系统表现为完全取测量值作为状态的后验估计值,而系统的先验状态估计完全被抛弃。反之当趋向于零时,根据式3.2可知,Q=0nx1易知,此时系统完全抛弃测量值,取先验估计值卡尔曼滤波
算法总结算法描述卡尔曼滤波器用反馈控制的方法估计过程状态。估计过程某一时刻的状态,然后以(含噪声)测量值得方式获得反馈,因此卡尔曼滤波器可以分为两个部分:1、时间更新方程负责向前推算当前状态向量和误差协方差估计的值,为下一个时间状态构成先验估计。2、测量更新方程负责将先验估计和新的测量变量结合已构成改进后的后验估计。卡尔曼滤波
算法总结时间更新方程测量更新方程卡尔曼滤波
算法总结算法框图
文档评论(0)