全站数据
8 4 2 0 5 8 1

卡尔曼滤波协方差计算方法

建筑资质通 | 简单学习,快乐成才!         
问题更新日期:2024-10-18 19:28:33

问题描述

卡尔曼滤波协方差计算方法急求答案,帮忙回答下
精选答案
最佳答案

KF滤波公式

假设已经知道xk−1服从均值为μk−1,方差为Pk−1的高斯分布。那么由状态转移模型可以得到对xk服从的高斯分布:

x−k=Fkx^k−1+Bkuk

P−k=FkPk−1FTk+Qk

这里没有参考第k次测量。如果加上第k次观测,可以得到xk的分布,其均值与方差为:

x^k=x^−k+K(zk−Hx−k)

Pk=P−k−KHkP−k

K=P−kHTk(HkP−kHTk+Rk)−1