视觉SLAM14讲学习笔记-ch4

 本博客主要记录学习高翔老师视觉SLAM14讲的总结笔记,若有总结不对的地方,欢迎大家与我讨论。

一、群

  • 群是一种集合加上一种运算的代数结构,即G(A,\cdot ),满足封结幺逆的性质。
  • 李群是指具有连续光滑性质的群,如SO(3)和SE(3)。

二、李代数

  • 李代数由一个集合N、一个数域F和一个二元运算\left [ , \right ]组成的,满足封闭性、双线性、自反性和雅可比等价性。李代数描述的是李群的局部性质,是李群单位元处的正切空间
  • 李代数so(3)是SO(3)对应的李代数,满足

R(t)=exp(\phi ^{\wedge }t), so(3)=\left \{ \phi \in \Re^{3}, \phi^{\wedge} \in \Re^ {3\times 3}\right \}

  • 李代数se(3)是SE(3)对应的李代数,满足 

se(3)=\left \{ \xi =\begin{bmatrix} \rho \\ \phi \end{bmatrix} \in \Re^{6} \mid \rho \in \Re^{3}, \phi \in so(3), \xi^{\wedge }=\begin{bmatrix} \phi^{\wedge } & \rho\\ 0^{T} & 0 \end{bmatrix} \in \Re^{4\times4 } \right \} 

其中,\rho表示平移,但与变换矩阵中的平移不同。 

三、指数映射和对数映射

 

四、BCH公式

 由于SO(3)对加法运算并不封闭,所以当求类似\frac{\mathrm{d} f(R)}{\mathrm{d} R},对SO(3)求导时,没有很好的导数性质,所以可以转换为李代数,从而具有导数性质。BCH公式如下所示:

ln(R_{1}R_{2})^{\vee }=ln(exp(\phi_{1}^{\wedge } )exp(\phi_{2}^{\wedge } ))^{\vee }\approx \left\{\begin{matrix} J_{l}(\phi_{2})^{-1}\phi_{1} +\phi_{2}\\ J_{r}(\phi_{1})^{-1}\phi_{2} +\phi_{1} \end{matrix}\right. 

 上式分别对应的左乘模型和右乘模型,其中J_{l}为:

J_{l}=J=\frac{\sin \theta }{\theta}I+(1-\frac{\sin \theta }{\theta}) aa^{T}+\frac{1-\cos \theta }{\theta}a^{\wedge }

J_{r}(\phi )=J_{l}(-\phi)

对于微小角度\exp(\bigtriangleup\phi ^{\wedge } )变化,根据左乘模型可以用李代数表达为:

 \exp(\bigtriangleup\phi ^{\wedge } )\exp(\phi ^{\wedge})=\exp((\phi+J_{l}^{-1}(\phi)\bigtriangleup\phi)^{\wedge })

\exp((\phi+\bigtriangleup \phi)^{\wedge })=\exp((J_{l}\bigtriangleup \phi)^{\wedge })\exp(\phi^{\wedge })

 由此,李群上相乘运算(角度相加)转换为李代数上的相加运算。

五、SO(3)上的李代数导数

5.1李代数求导模型

 详细推导过程,可看书P84,结果为:

\frac{\partial (\exp(\phi^{\wedge })P)}{\partial \phi} =-(RP)^{\wedge }J_{l} 

5.2扰动模型

 左扰动:

\frac{\partial (Rp)}{\partial \varphi } =-(Rp)^{\wedge }

右扰动:

\frac{\partial (Rp)}{\partial \varphi } =-Rp^{\wedge } 

六、SE(3)上的李代数求导

左扰动: 

\frac{\partial (Tp)}{\partial \bigtriangleup \xi } =\begin{bmatrix} I & -(Rp+t)^{\wedge }\\ 0^{T} & 0^{T} \end{bmatrix} 

右扰动:

\frac{\partial (Tp)}{\partial \bigtriangleup \xi } =\begin{bmatrix} R & -Rp^{\wedge }\\ 0^{T} & 0^{T} \end{bmatrix} 

评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值