- 1、本文档共38页,可阅读全部内容。
- 2、原创力文档(book118)网站文档一经付费(服务费),不意味着购买了该文档的版权,仅供个人/单位学习、研究之用,不得用于商业用途,未经授权,严禁复制、发行、汇编、翻译或者网络传播等,侵权必究。
- 3、本站所有内容均由合作方或网友上传,本站不对文档的完整性、权威性及其观点立场正确性做任何保证或承诺!文档内容仅供研究参考,付费前请自行鉴别。如您付费,意味着您自己接受本站规则且自行承担风险,本站不退款、不进行额外附加服务;查看《如何避免下载的几个坑》。如果您已付费下载过本站文档,您可以点击 这里二次下载。
- 4、如文档侵犯商业秘密、侵犯著作权、侵犯人身权等,请点击“版权申诉”(推荐),也可以打举报电话:400-050-0827(电话支持时间:9:00-18:30)。
- 5、该文档为VIP文档,如果想要下载,成为VIP会员后,下载免费。
- 6、成为VIP后,下载本文档将扣除1次下载权益。下载后,不支持退款、换文档。如有疑问请联系我们。
- 7、成为VIP后,您将拥有八大权益,权益包括:VIP文档下载权益、阅读免打扰、文档格式转换、高级专利检索、专属身份标志、高级客服、多端互通、版权登记。
- 8、VIP文档为合作方或网友上传,每下载1次, 网站将根据用户上传文档的质量评分、类型等,对文档贡献者给予高额补贴、流量扶持。如果你也想贡献VIP文档。上传文档
查看更多
卡尔曼滤波 ;1 卡尔曼滤波与最优估计;1.1最小方差估计;估计的均方误差就是估计误差的方差,即:;1.2线性最小方差估计;有关量测量Z的线性函数有无穷多个,但能使X具有最小方差估计的线性函数只有一个,记为
;因此X在Z上的线性最小方差估计为;1.2.1线性最小方差估计的性质;其中F为确定性矩阵,e为确定性向量。;1.3递推线性最小方差估计——卡尔曼滤波 ;在k时刻以前估值的基础上,根据k时刻的量测值Zk,递推得到k时刻的状态估计值 :;2 卡尔曼滤波方程;Qk和Rk分别称为系统噪声和量测噪声的方差矩阵,在卡尔曼滤波中要求它们分别是已知值的非负定阵和正定阵; ; Var{·} 为对{·}求方差的符号
;2.2 离散卡尔曼滤波方程 ;2.2 离散卡尔曼滤波方程 ;(1)状态一步预测方程; 上式就是通过 计算新息,把 估计出来,并左乘一个系数矩阵 加到 中,从而得到 估值 和, 称为滤波增益矩阵;由于 也具有无偏性,即 的均值为零,所以
也称为一步预测误差方差阵。上式中的 和 分别就是新息中的两部分内容;(4)一步预测均方误差方程;(5)估计均方误差方程;(6)卡尔曼滤波的计算流程;2.3离散卡尔曼滤波基本方程使用要点;有上述的卡尔曼滤波基本方程中的均方误差的公式;由卡尔曼滤波方程的推导得知,基本方程只适用于系统方程和量测方程都是离散型的情况。但实际的物理系统一般都是连续的,动力学特性用连续的微分方程来描述。所以在使用卡尔曼基本方程之前,必须对系统方程和量测方程进行离散化处理。
设描述物理系统动力特性的系统方程为;q为w(t)的方差强度矩阵。;对该方程求解并进行约等变化,得;一步预测方程改为:;5.一步预测基本方程;
则;例1 设有线定常系统;;例2 α-β-γ滤波
设运动体沿某一直线运动,tk时刻的位移、速度、加速度、加加速度分别为sk,vk,ak,jk,只对运动体的位置做测量,测量值为Zk=sk+Vk,若;;;;设系统方程和量测方程的一般形式为;谢 谢
文档评论(0)