视觉SLAM十四讲 第9讲 后端1 贝叶斯法则 式9.5推导
视觉SLAM十四讲 第9讲 后端1 贝叶斯法则 式9.5推导
在学习高博的视觉SLAM十四讲第9讲后端1的时候,看到了式9.5,有如下内容:
下面我们来看如何对状态进行估计。按照贝叶斯法则,把zkz_kzk和xkx_kxk交换位置,有:
P(xk∣x0,u1:k,z1:k)∝P(zk∣xk)P(xk∣x0,u1:k,z1:k−1)(9.5)P(x_k|x_0,u_{1:k},z_{1:k})\propto P(z_k|x_k)P(x_k|x_0,u_{1:k},z_{1:k-1})\tag{9.5}P(xk∣x0,u1:k,z1:k)∝P(zk∣xk)P(xk∣x0,u1:k,z1:k−1)(9.5)
读者应该不会感到陌生。这里的第一项称为似然,第二项称为先验。
我最讨厌这种有“易知”、“容易推出”、“即可得”但是又不明白怎么来的的感觉。贝叶斯定理基本的我知道,似然我知道,先验我知道,可是你说交换了位置就直接有了这个式子是怎么来的呢。。。为了解决这种痛苦,请了数理学院的大佬帮忙推导博客主页
关键点在于:
- 式9.5的推导是省略了一些步骤的
- 关键点在于P235页的式9.3。xkx_kxk和u,zu,zu,z有关,而zkz_kzk只和当前时刻的xkx_kxk有关。意思是说zkz_kzk和x0,u1:k,z1:k−1x_0,u_{1:k},z_{1:k-1}x0,u1:k,z1:k−1是相互独立的。
- 所以可以根据贝叶斯定理、条件概率公式、相互独立的性质进行推导
基本的公式/性质:
贝叶斯定理
:P(A∣B)=P(B∣A)P(A)P(B)P(A|B) = \frac{P(B|A)P(A)}{P(B)}P(A∣B)=P(B)P(B∣A)P(A)
条件概率
:P(A∣B)=P(AB)P(B)P(A|B) = \frac{P(AB)}{P(B)}P(A∣B)=P(B)P(AB)
相互独立
:若A与B相互独立,则P(A∣B)=P(A)P(A|B)=P(A)P(A∣B)=P(A)
现在可以开始推导,为了书写的简洁,我们令事件集(x0,u1:k,z1:k−1)=B(x_0,u_{1:k},z_{1:k-1})=B(x0,u1:k,z1:k−1)=B:
P(xk∣x0,u1:k,z1:k)=P(xk∣B,zk)=P(xk,B,zk)P(B,zk)=P(zk∣xk,B)P(xk,B)P(B,zk)=P(zk∣xk)P(xk,B)P(B,zk)=P(zk∣xk)P(xk∣B)P(B)P(B)P(zk)=P(zk∣xk)P(xk∣B)P(zk)=P(zk∣xk)P(xk∣x0,u1:k,z1:k−1)P(zk)\begin{aligned}P(x_k|x_0,u_{1:k},z_{1:k}) &= P(x_k|B,z_k) \\ &= \frac{P(x_k,B,z_k)}{P(B,z_k)} = \frac{P(z_k|x_k,B)P(x_k,B)}{P(B,z_k)} \\ &= \frac{P(z_k|x_k)P(x_k,B)}{P(B,z_k)}\\ &= \frac{P(z_k|x_k)P(x_k|B)P(B)}{P(B)P(z_k)} \\ &= \frac{P(z_k|x_k)P(x_k|B)}{P(z_k)} \\ &= \frac{P(z_k|x_k)P(x_k|x_0,u_{1:k},z_{1:k-1})}{P(z_k)}\end{aligned}P(xk∣x0,u1:k,z1:k)=P(xk∣B,zk)=P(B,zk)P(xk,B,zk)=P(B,zk)P(zk∣xk,B)P(xk,B)=P(B,zk)P(zk∣xk)P(xk,B)=P(B)P(zk)P(zk∣xk)P(xk∣B)P(B)=P(zk)P(zk∣xk)P(xk∣B)=P(zk)P(zk∣xk)P(xk∣x0,u1:k,z1:k−1)
式子推导过程中应用到了贝叶斯定理
、条件概率
和事件相互独立
的性质,最后把P(zk)P(z_k)P(zk)略去,把等于号变成正比于符号,便有:
P(xk∣x0,u1:k,z1:k)∝P(zk∣xk)P(xk∣x0,u1:k,z1:k−1)P(x_k|x_0,u_{1:k},z_{1:k}) \propto P(z_k|x_k)P(x_k|x_0,u_{1:k},z_{1:k-1})P(xk∣x0,u1:k,z1:k)∝P(zk∣xk)P(xk∣x0,u1:k,z1:k−1)
敲公式不易,点个赞再走吧~~~
如果大佬觉得有什么更好的推导或者理解思路,欢迎留言一起讨论~~
视觉SLAM十四讲 第9讲 后端1 贝叶斯法则 式9.5推导相关推荐
- 视觉SLAM总结——视觉SLAM十四讲笔记整理
视觉SLAM总结--视觉SLAM十四讲笔记整理 说明 基础知识点 1. 特征提取.特征匹配 (1)Harris (2)SIFT (3)SUFT (4)ORB (5)特征匹配 2. 2D-2D:对极约束 ...
- 浅读《视觉SLAM十四讲:从理论到实践》--操作1--初识SLAM
浅读<视觉SLAM十四讲:从理论到实践>--操作1--初识SLAM 下载<视觉SLAM十四讲:从理论到实践>源码:https://github.com/gaoxiang12/s ...
- 视觉SLAM十四讲(3):三维空间刚体运动
本章需要掌握的知识点有:旋转矩阵,变换矩阵,四元数,欧拉角定义和数学表达:同时也要掌握Eigen库关于矩阵.几何模块的使用方法. 文章目录 3.1 旋转矩阵 3.1.1 点,向量和矩阵的关系 3.1. ...
- 视觉SLAM十四讲(2):初识SLAM
这一讲主要介绍视觉SLAM的结构,并完成第一个SLAM程序:HelloSLAM. 目录 2.1 小萝卜的例子 单目相机 双目相机 深度相机 2.2 经典视觉SLAM框架 2.3 SLAM问题的数学表述 ...
- 视觉SLAM十四讲(1):预备知识
最近在学习高翔博士的<视觉SLAM十四讲>(第二版),算是初学本书,配套资源还算蛮丰富的,有代码(第一版和第二版都有),B站上也有高翔博士对第一版录制的讲解视频,真的是很贴心. 来吧,让我 ...
- 视觉slam十四讲 pdf_视觉SLAM十四讲|第12讲 回环检测
1. 什么是回环检测 前面有说过累积误差的问题,前一时刻的误差会积累到后面,导致画不成圈圈,如图12-1所示,而画圈圈(全局一致性)很重要,所以需要有一个步骤来纠正当前的计算偏差. 回环检测通过判断相 ...
- 视觉SLAM十四讲学习笔记-第七讲-视觉里程计-三角测量和实践
专栏汇总 视觉SLAM十四讲学习笔记-第一讲_goldqiu的博客-CSDN博客 视觉SLAM十四讲学习笔记-第二讲-初识SLAM_goldqiu的博客-CSDN博客 视觉SLAM十四讲学习笔记-第 ...
- 视觉SLAM十四讲学习笔记-第七讲-视觉里程计-对极几何和对极约束、本质矩阵、基础矩阵
专栏系列文章如下: 专栏汇总 视觉SLAM十四讲学习笔记-第一讲_goldqiu的博客-CSDN博客 视觉SLAM十四讲学习笔记-第二讲-初识SLAM_goldqiu的博客-CSDN博客 视觉SLA ...
- 视觉SLAM十四讲学习笔记-第六讲学习笔记总结(1)---非线性优化原理
第六讲学习笔记如下: 视觉SLAM十四讲学习笔记-第六讲-非线性优化的状态估计问题_goldqiu的博客-CSDN博客 视觉SLAM十四讲学习笔记-第六讲-非线性优化的非线性最小二乘问题_ ...
最新文章
- TypeError: can only concatenate str (not “int“) to str
- JAVA 设计模式 模板方法模式
- mysql40190_MySQL 内核深度优化
- JMeter测试TCP/IP Socket应用的性能
- 架构师之路 — 软件架构 — 架构软件的过程
- 一文搞定Vim/Vi编辑器
- 标准库 - 输入输出处理(input and output facilities) lua
- 病案编码员需要计算机的什么知识,如何成为一名优秀的病案编码员?
- 博客目录(随时删除)
- java word 转换 图片_怎样把手机上的图片转换成word?
- 浅谈C++类(6)--复制构造函数
- 使自定义控件居中于父容器的计算公式
- java 中的doit(n)_CoreJava测试题(含答案).docx
- Python刷题-4
- 如何在C#中使用反射获取集合元素类型
- JAVA作业 17-05-18
- 我国电子商务发展的进化策略
- 一个软件项目如何做成本预估
- [Vue]@keyup.enter不起作用
- sublime text3--js智能提示插件以及其他常用插件