从概率角度出发的卡尔曼滤波器推导

根据《视觉SLAM14讲:从理论到实践》的P106-P107、P237-P243以及相关的概率方面的基础进行总结。以高翔博士P237-P243中公式为主线进行展开。目的是加强这个方面的联系感。

被不严谨的公式折磨死了,好难受,本文的目标:把公式解释明白,推不了先这样。

为什么要线性化?1个高斯分布,经过非线性变换之后,就不再是高斯了,所以要对非线性的进行线性化。这么理解就行。

概率P(..|..)  明白白表示即可,其他不要理解了,很难受,主要是为了和高斯分布联系起来。像公式10.11   10.13   10.14

将概率分布建模为高斯分布进行求解,这样我们只关注随机变量的均值和方差。

公式10.3    把特征点的世界坐标yj去掉之后,理解好难受。

运动方程:之前的位置估计是xk-1,给一个控制量uk,得到xk。wk是噪声。

观测方程:在估计的位置xk处观测到的空间点特征yj,得到一次观测zk,j。

公式10.4   基于比如使用里程计进行的预测,以及所有的观测来估计当前的状态xk。

公式10.5   10.4说的是后验,正比于似然乘以先验。

极大似然估计:在怎样的状态下,现在的观测数据最有可能发生。

知乎的解释:https://www.zhihu.com/question/20447622

知乎上的比较合理的解释

先验估计:现在的状态依据预测基于过去所有的观测(不包含现在的观测)!

公式10.6   10.7   10.8  有啥用,与后面都不一样 

公式10.6   不懂

公式10.7   假设公式10.6正确 

公式10.8   公式10.6第二个部分

公式10.9   运动方程和观测方程用线性方程来描述。

公式10.10   噪声服从均值为0的高斯分布

公式10.11   状态预测的均值和方差

公式10.12   状态预测的均值和方差 

公式10.13   观测的均值和方差

公式10.14   和公式10.5联系起来  为什么10.11 10.12 10.13 这么写,因为想和10.14联系起来

公式10.15   假设公式是这样的。带帽子的是后验,带横干的是先验。

公式10.16   假设公式是这样的。

公式10.17   自己设的。

公式10.18   依据10.16

公式10.19   公式10.18 等式两边右乘先验方差的逆得出公式10.19,依据10.18 假设先验方差的逆乘以先验方差等于单位阵。

公式10.20   假设是这样的。

公式10.21   除以-2、等式两边能同时除以xk?矩阵的逆的转置等于矩阵的逆?

公式10.22   公式10.23   公式10.21左乘后验方差。

公式10.24   和公式10.12 对上。先验的均值和方差

公式10.25   对不上?

公式10.26   10.23 10.19 对上 后验的矩阵和方差

公式10.27   在某一点处进行线性展开。

公式10.28   偏导数。

公式10.29   在某一点处进行一阶泰勒展开。

公式10.31   公式10.32   公式10.33   公式10.35 不懂

公式10.34   自己定义的K(卡尔曼增益)

==========================================

卡尔曼增益受噪声协方差的影响

最后编辑于
©著作权归作者所有,转载或内容合作请联系作者
  • 序言:七十年代末,一起剥皮案震惊了整个滨河市,随后出现的几起案子,更是在滨河造成了极大的恐慌,老刑警刘岩,带你破解...
    沈念sama阅读 204,445评论 6 478
  • 序言:滨河连续发生了三起死亡事件,死亡现场离奇诡异,居然都是意外死亡,警方通过查阅死者的电脑和手机,发现死者居然都...
    沈念sama阅读 85,889评论 2 381
  • 文/潘晓璐 我一进店门,熙熙楼的掌柜王于贵愁眉苦脸地迎上来,“玉大人,你说我怎么就摊上这事。” “怎么了?”我有些...
    开封第一讲书人阅读 151,047评论 0 337
  • 文/不坏的土叔 我叫张陵,是天一观的道长。 经常有香客问我,道长,这世上最难降的妖魔是什么? 我笑而不...
    开封第一讲书人阅读 54,760评论 1 276
  • 正文 为了忘掉前任,我火速办了婚礼,结果婚礼上,老公的妹妹穿的比我还像新娘。我一直安慰自己,他们只是感情好,可当我...
    茶点故事阅读 63,745评论 5 367
  • 文/花漫 我一把揭开白布。 她就那样静静地躺着,像睡着了一般。 火红的嫁衣衬着肌肤如雪。 梳的纹丝不乱的头发上,一...
    开封第一讲书人阅读 48,638评论 1 281
  • 那天,我揣着相机与录音,去河边找鬼。 笑死,一个胖子当着我的面吹牛,可吹牛的内容都是我干的。 我是一名探鬼主播,决...
    沈念sama阅读 38,011评论 3 398
  • 文/苍兰香墨 我猛地睁开眼,长吁一口气:“原来是场噩梦啊……” “哼!你这毒妇竟也来了?” 一声冷哼从身侧响起,我...
    开封第一讲书人阅读 36,669评论 0 258
  • 序言:老挝万荣一对情侣失踪,失踪者是张志新(化名)和其女友刘颖,没想到半个月后,有当地人在树林里发现了一具尸体,经...
    沈念sama阅读 40,923评论 1 299
  • 正文 独居荒郊野岭守林人离奇死亡,尸身上长有42处带血的脓包…… 初始之章·张勋 以下内容为张勋视角 年9月15日...
    茶点故事阅读 35,655评论 2 321
  • 正文 我和宋清朗相恋三年,在试婚纱的时候发现自己被绿了。 大学时的朋友给我发了我未婚夫和他白月光在一起吃饭的照片。...
    茶点故事阅读 37,740评论 1 330
  • 序言:一个原本活蹦乱跳的男人离奇死亡,死状恐怖,灵堂内的尸体忽然破棺而出,到底是诈尸还是另有隐情,我是刑警宁泽,带...
    沈念sama阅读 33,406评论 4 320
  • 正文 年R本政府宣布,位于F岛的核电站,受9级特大地震影响,放射性物质发生泄漏。R本人自食恶果不足惜,却给世界环境...
    茶点故事阅读 38,995评论 3 307
  • 文/蒙蒙 一、第九天 我趴在偏房一处隐蔽的房顶上张望。 院中可真热闹,春花似锦、人声如沸。这庄子的主人今日做“春日...
    开封第一讲书人阅读 29,961评论 0 19
  • 文/苍兰香墨 我抬头看了看天上的太阳。三九已至,却和暖如春,着一层夹袄步出监牢的瞬间,已是汗流浃背。 一阵脚步声响...
    开封第一讲书人阅读 31,197评论 1 260
  • 我被黑心中介骗来泰国打工, 没想到刚下飞机就差点儿被人妖公主榨干…… 1. 我叫王不留,地道东北人。 一个月前我还...
    沈念sama阅读 45,023评论 2 350
  • 正文 我出身青楼,却偏偏与公主长得像,于是被迫代替她去往敌国和亲。 传闻我的和亲对象是个残疾皇子,可洞房花烛夜当晚...
    茶点故事阅读 42,483评论 2 342