【后验概率】
p
(
x
∣
y
)
p(x|y)
p(x∣y)为在某观测值
y
y
y下的状态
x
x
x的PDF 【似然】
p
(
y
∣
x
)
p(y|x)
p(y∣x)为传感器模型,也就是在不同的状态
x
x
x下的观测值
y
y
y的PDF 【先验概率】
p
(
x
)
p(x)
p(x)为状态
x
x
x本身的PDF
p
(
y
)
p(y)
p(y)是传感器观测值本身的PDF,一般很难直接计算
p
(
x
)
p(x)
p(x)若看做是均匀分布,也就说在某次观测中,不考虑观测值,直接去猜测状态量,那么所有状态量出现的可能性都是一样多的。但在实践中,某次观测的状态量往往与上次的状态量相关,因此
p
(
x
)
p(x)
p(x)并不是均匀分布的。
在最后一步极坐标换元操作中,需要对原积分公式的3处进行替换:(1)被积分的表达式,这个是显然的;(2)积分上下界;(3)
d
t
d
u
dt du
dtdu替换为
r
d
r
d
θ
rdrd\theta
rdrdθ。
第(3)步值得说道一下。 直接地,分别求出
再将它们直接相乘会得到错误的结果,原因是
d
t
dt
dt、
d
u
du
du等符号比较特殊,不能看做单纯的变量,再深入问为什么我也不知道了。
因此,一般会采用雅克比矩阵来进行换元,暂且记住它吧。
高斯推断/边缘化-联合高斯分布
我们希望利用前面所说的贝叶斯公式:
在已知联合分布和边缘分布的情况下推导出条件分布。我们需要求出条件分布的均值和协方差矩阵。这就要求我们把
p
(
x
,
y
)
p(x,y)
p(x,y)的协方差矩阵的逆拆成块状,以便于我们把它的随机变量中的
x
x
x部分和
y
y
y部分分离出来。下面会进行详细解释。
分块矩阵打洞:
第一种方式:
其中,
D
−
C
A
−
1
B
D-CA^{-1}B
D−CA−1B叫做
A
A
A的舒尔补(Schur Complement)。
第二种方式:
其中,
A
−
B
D
−
1
C
A-BD^{-1}C
A−BD−1C叫做
D
D
D的舒尔补(Schur Complement)。
进一步地,为了呈现课程PPT中的形式,把第二种方式左侧两个操作矩阵取逆放到右侧,有
再把公式左右两侧都取逆,有
把上述示例矩阵替换为协方差矩阵,就可以得到以下的形式:
这么做的目的是,为了可以把大的联合的协方差的矩阵的求逆转换为一个新矩阵内部的分块的求逆,便于代入高斯密度函数中的二次型,即
(
x
−
μ
)
T
Σ
−
1
(
x
−
μ
)
(x-\mu)^T\Sigma^{-1}(x-\mu)
(x−μ)TΣ−1(x−μ),如下:
上述的二次型同时包含了期望和协方差信息,也就是高斯分布的全部信息了。
我们上面了做了这么多工作的目的是进行边缘化,也就是把条件概率密度函数从联合概率密度函数中分离出来,依据以下公式:
p
(
x
,
y
)
=
p
(
x
∣
y
)
p
(
y
)
p(x,y) = p(x|y)p(y)
p(x,y)=p(x∣y)p(y) 由于二次型包含了高斯分布的全部信息,因此我们只需要在二次型中把
p
(
x
∣
y
)
p(x|y)
p(x∣y)和
p
(
y
)
p(y)
p(y)的期望和协方差分离出来就行。借助上面的矩阵打洞,我们把
p
(
x
,
y
)
p(x,y)
p(x,y)的协方差的逆顺利拆散了,并进行分离。