首页 > 移动平台 > 详细

卡尔曼滤波——17.高斯移动

时间:2018-05-02 17:58:01      阅读:329      评论:0      收藏:0      [点我收藏+]

回顾一下之前的内容,我们知道有一个测量更新和一个运动更新(预测)。

运动更新通过全概率或者一个加法来完成,我们已经解决了比较复杂的情况。

我把它解决了 ,并得出了公式。

技术分享图片

并且也用代码实现了这一步。

技术分享图片

运动部分不想深入,这是非常简单的一步,让我们写下来。假设你活在这样一个世界里,中心点,这是你对自己所在位置的最佳估计,高斯函数是你的误差。

技术分享图片

假设你往右移动了一定距离,并且运动本身也包含自己的误差,那么你就到达一个将运动量加到均值上的预测位置,并且这还会在初始误差上增加一个误差。

技术分享图片

 

 

如果你往右移动了这段距离(绿色线),在期望上你是到达了你想到的地方,但你会丢失信息,因为你的移动本来就会丢失信息,表现在这里的误差上。

技术分享图片

 

这个在数学上很容易实现,新的平均值等于旧的平均值加上动作,常称为U.

假设你运动了10米 这里将是绿色线将是10米,新的sigma平方等于旧的sigma的平方加上运动的高斯分布方差。

技术分享图片

这就是你所需知道的,这不过是一个相加。

测试:

技术分享图片

技术分享图片

 

卡尔曼滤波——17.高斯移动

原文:https://www.cnblogs.com/fuhang/p/8981524.html

(0)
(0)
   
举报
评论 一句话评论(0
关于我们 - 联系我们 - 留言反馈 - 联系我们:wmxa8@hotmail.com
© 2014 bubuko.com 版权所有
打开技术之扣,分享程序人生!