![智能驾驶之激光雷达算法详解](https://wfqqreader-1252317822.image.myqcloud.com/cover/487/50233487/b_50233487.jpg)
上QQ阅读APP看书,第一时间看更新
2.1.3 旋转的轴角表示/旋转向量表示
事实上,我们还可以使用一个旋转轴和旋转角度来描述空间旋转或姿态。若进一步使一个向量的朝向与这个旋转轴一致,并使这个向量的模长等于旋转角度,则可以得到描述空间旋转或姿态的旋转向量表示形式,一些学者也将其称为旋转的轴角表示形式。图2-8展示了空间中的一点绕单位长度的转轴
旋转
角度而得到
点的过程,在此过程中,如果旋转是绕轴逆时针进行的,则角度为正。
![](https://epubservercos.yuewen.com/4AC89A/29556666103448906/epubprivate/OEBPS/Images/2-8.jpg?sign=1739277913-tgCRCqYHcu5o9O8Zc1FNf0FIAfPKfs3e-0-1f5b7dfc5277507ea28000fd2e9ffcfc)
图2-8 空间旋转的轴角表示示意图
可以看出,旋转向量使用了4个变量来描述3个自由度的旋转,与旋转矩阵相比,它是空间旋转的一种紧凑表达。法国数学家本杰明·奥伦德·罗德里格斯给出了由旋转向量到旋转矩阵的转换关系:
![](https://epubservercos.yuewen.com/4AC89A/29556666103448906/epubprivate/OEBPS/Images/79.jpg?sign=1739277913-mlCS4MScgshS0F6cU3UVCcfqzcZ1ga6R-0-23db5ffa317e75c0891f8a2d6545e960)
(2-22)
其中为向量
的反对称阵,若
,则
为
![](https://epubservercos.yuewen.com/4AC89A/29556666103448906/epubprivate/OEBPS/Images/84.jpg?sign=1739277913-hxPEPcHRdr5QJKa5BKOmx2ca1GIUuaLs-0-d5363cd4cfa4576d97fa89a78a26ee80)
(2-23)
式(2-22)即著名的罗德里格斯旋转公式,详细的推导证明这里不再给出,读者可以参考相关论文、博客。基于式(2-22),我们分别求等式两侧矩阵对角线元素之和,即对式(2-22)取迹,这可以进一步得到由旋转矩阵到旋转向量的转换关系:
![](https://epubservercos.yuewen.com/4AC89A/29556666103448906/epubprivate/OEBPS/Images/85.jpg?sign=1739277913-1d8Nu74qHIFszMwDxRR6RulrzfHznENu-0-a3d794029783df46b7b92ed7cc40f833)
(2-24)
当时,我们可以进一步得到单位转轴矢量:
![](https://epubservercos.yuewen.com/4AC89A/29556666103448906/epubprivate/OEBPS/Images/87.jpg?sign=1739277913-lEHIVGW6O6p1u3UMW0ep2cifdSiM0SLp-0-a698a3285e5a273237954be284713ae1)
(2-25)
其中表示旋转矩阵
在第i行第j列的元素值。
然而,虽然旋转向量能够给出空间旋转的紧凑表达,但是其存在下列两个问题。
(1)不唯一性:我们可以看出,绕旋转
角度和绕
旋转
角度是等效的,因此同一个旋转通常有多种旋转向量的表示形式。
(2)奇异性:当为单位阵且
时,转轴
可以随意选取。