视觉SLAM十四讲学习笔记——第三讲 三维空间刚体运动

1.旋转矩阵的正交性

        P45下方注解第一条“旋转矩阵的正交性可直接由定义给出”,在查阅众多证明方法之后,我选择一种个人更容易理解的方法。

       首先明确:正交矩阵即逆为自身转置的矩阵,即满足视觉SLAM十四讲学习笔记——第三讲 三维空间刚体运动,因此要证明旋转矩阵的转置矩和逆矩阵是同一个矩阵。对于转置矩阵较为简单:

视觉SLAM十四讲学习笔记——第三讲 三维空间刚体运动

        对于旋转矩阵的逆,可以从物理意义上考虑,即为反向旋转对应的旋转矩阵(经过两次旋转回到初始状态,对应矩阵相乘结果为单位矩阵),因此只需要调换对应基底就可以得到旋转矩阵的逆矩阵:

 视觉SLAM十四讲学习笔记——第三讲 三维空间刚体运动

        对比旋转矩阵的转置矩阵和逆矩阵,对应的每一项数值相同,因此有:

视觉SLAM十四讲学习笔记——第三讲 三维空间刚体运动

        即可证明:旋转矩阵是正交矩阵。

2.平移变换的反变换

        P46上方描述平移向量“平移变换 t 的反变换不是 -t ,而是和两个系的旋转有关系”。这个问题可以简单推导一下:

视觉SLAM十四讲学习笔记——第三讲 三维空间刚体运动

        得到平移变换的反变换:

        

视觉SLAM十四讲学习笔记——第三讲 三维空间刚体运动

         这一结果在变换矩阵 T 的定义也可以看到,变换矩阵定义:

视觉SLAM十四讲学习笔记——第三讲 三维空间刚体运动

         求变换矩阵的逆矩阵,根据分块矩阵求逆的方法,特别当左下角为零矩阵时:

视觉SLAM十四讲学习笔记——第三讲 三维空间刚体运动

         求得变换矩阵的逆矩阵:

视觉SLAM十四讲学习笔记——第三讲 三维空间刚体运动

          这种推导方式得到的逆矩阵右上角的平移向量和最初的推导结果完全相同。

3.罗德里格斯公式推导

         罗德里格斯公式:描述旋转向量到旋转矩阵的变换过程。

         这部分推导比较复杂,直接拍草稿纸了:

视觉SLAM十四讲学习笔记——第三讲 三维空间刚体运动

        各别过程有一点混乱,也是对比了不同的证明方法,选了一种我最容易理解的。

4.欧拉角万向锁问题 

         P55提到欧拉角存在一个重大缺点“万向锁问题”,也被称为奇异性问题。

        最初我对万向锁的理解不太到位,找了一些讲解视频看起来就清晰很多,视频链接https://v.youku.com/v_show/id_XNzkyOTIyMTI=.html主要针对“奇异性”问题,我的理解是“当给出一个旋转变换,是否有且仅有一组欧拉角可以描述这个旋转过程?”,答案很明显,在大多数情况下是这样的,但当第二次旋转俯仰角为±90°的时候,就有多组欧拉角描述同一个旋转变换(偏航和滚转是同一个轴的旋转变换),因此欧拉角存在奇异性!同样的旋转向量也存在奇异性,转角超过2π时而产生的周期性。

5.四元数表示旋转

         用四元数表达对一个点的旋转:

视觉SLAM十四讲学习笔记——第三讲 三维空间刚体运动

         乘法均为四元数乘法,结果也是四元数,且为纯虚四元数。

         证明过程:https://blog.csdn.net/gxsheen/article/details/79156817,证明过程完全是大量的计算,没有什么技巧可言,不想自己推一遍了。

6.对比几种旋转变换的描述方式

描述方式 优点 缺点
旋转矩阵

可以表示描述任意旋转过程

冗余性:用9个量表示仅有3个*度的旋转、不直观

自带约束:必须正交,且行列式为1,不利于优化算法。

旋转向量 仅使用3个变量 奇异性问题、不直观
欧拉角 简单、直观,数据较少:仅需要3个量 任何形式的欧拉角都存在万向锁问题(奇异性问题)
四元数 紧凑:用4个量描述、没有奇异性、可以实现平滑插值(最关键的优势) 理解最困难、最不直观

上一篇:Semantic Visual SLAM in Populated Environments


下一篇:视觉SLAM面试题汇总(二)