![智能驾驶之激光雷达算法详解](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=1738910029-E4I9ry8zdwThqUSgHXPmERGBsnPLbJ8B-0-2975596ca37997af5e6780019034fbf0)
图2-8 空间旋转的轴角表示示意图
可以看出,旋转向量使用了4个变量来描述3个自由度的旋转,与旋转矩阵相比,它是空间旋转的一种紧凑表达。法国数学家本杰明·奥伦德·罗德里格斯给出了由旋转向量到旋转矩阵的转换关系:
![](https://epubservercos.yuewen.com/4AC89A/29556666103448906/epubprivate/OEBPS/Images/79.jpg?sign=1738910029-VqMpN9jhMtjt3v3UTiWruJtlNk4Ni59F-0-682731085c9c9f8bcb83c93c573d3570)
(2-22)
其中为向量
的反对称阵,若
,则
为
![](https://epubservercos.yuewen.com/4AC89A/29556666103448906/epubprivate/OEBPS/Images/84.jpg?sign=1738910029-M0iSChusl8n540w6I5EAQU7DGBxbMeRD-0-3f3a518071ee40e9aca28c89010a486f)
(2-23)
式(2-22)即著名的罗德里格斯旋转公式,详细的推导证明这里不再给出,读者可以参考相关论文、博客。基于式(2-22),我们分别求等式两侧矩阵对角线元素之和,即对式(2-22)取迹,这可以进一步得到由旋转矩阵到旋转向量的转换关系:
![](https://epubservercos.yuewen.com/4AC89A/29556666103448906/epubprivate/OEBPS/Images/85.jpg?sign=1738910029-a9W5EmbQ4kSiv2Qd3Oe4bjhDMI5mFmVP-0-c718586ae7f83321bdc6b6d8aac20a93)
(2-24)
当时,我们可以进一步得到单位转轴矢量:
![](https://epubservercos.yuewen.com/4AC89A/29556666103448906/epubprivate/OEBPS/Images/87.jpg?sign=1738910029-omBTbpQPoZ5gSc9pnzeeK0UkVWmMknBb-0-a9a60261c4df6acc9b12fceac8947548)
(2-25)
其中表示旋转矩阵
在第i行第j列的元素值。
然而,虽然旋转向量能够给出空间旋转的紧凑表达,但是其存在下列两个问题。
(1)不唯一性:我们可以看出,绕旋转
角度和绕
旋转
角度是等效的,因此同一个旋转通常有多种旋转向量的表示形式。
(2)奇异性:当为单位阵且
时,转轴
可以随意选取。