kalman filter java_Kalman filters(一)

3.1理论推导

首先假设状态变量为x,观测量为z,那么结合贝叶斯后验概率模型:

equation?tex=posterior+%3D+%5Cfrac%7B%7Blikelihood+%5Ctimes+prior%7D%7D%7B%7Bnormalization%7D%7D+%5CLeftrightarrow+P%5Cleft%28+%7B%5Cleft.+x+%5Cright%7Cz%7D+%5Cright%29+%3D+%5Cfrac%7B%7BP%5Cleft%28+%7B%5Cleft.+z+%5Cright%7Cx%7D+%5Cright%29P%5Cleft%28+x+%5Cright%29%7D%7D%7B%7BP%5Cleft%28+z+%5Cright%29%7D%7D%5C%5C

多目标跟踪从形式上讲可以理解为最大化后验概率,现在结合第二节的内容,假设状态变量x服从高斯分布,反映的是运动模型的不稳定性。基于状态变量x的估计先验,观测量z也服从高斯分布,反映的是量测误差,比如传感器误差。那么我们就可以利用高斯分布的融合来刻画Kalman滤波器的更新部分。

这里我们先给出一阶Kalman滤波器的公式,其中预测环节就是基于线性运动特性对状态变量的预测,即:

equation?tex=%5Cbegin%7Barray%7D%7Bl%7D+x+%3D+Fx+%2B+Bu%5C%5C+P+%3D+FxF%5ET+%2B+Q+%5Cend%7Barray%7D%5C%5C

其中​

equation?tex=x 为状态变量的均值,​

equation?tex=P 为预测方差,那么​对应的高斯分布方差即为

equation?tex=FPF%5ET,而​

equation?tex=Q 则是线性运动模型本身的误差,由此得到预测环节。即预测结果服从高斯分布

  • 0
    点赞
  • 0
    收藏
    觉得还不错? 一键收藏
  • 0
    评论

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值