机器人学基础--运动学--2.2 旋转矩阵

二、机器人运动学

2.2 刚体的旋转–旋转矩阵

（1）旋转矩阵是坐标轴的投影
已知：

如果令：

可以理解为{B}坐标系X轴的单位向量。此时有等式右侧的结果是旋转矩阵R的第一列。就是旋转矩阵R的第一列代表了坐标系{B}的x轴在坐标系{A}中坐标。而我们又知道所谓的坐标那就是向量在参考坐标系各个轴上的投影。因此，更为清晰一点的阐述应该是旋转矩阵R的第一列代表了坐标系{B}的x轴在坐标系{A}的三个轴上的投影。
同理我们得到旋转矩阵的第二列代表坐标系{B}的y轴单位向量在坐标系{A}的投影，第三列代表坐标系{B}的z轴单位向量在坐标系{A}的投影。我大多数时候列写旋转矩阵都是通过这一条结论。

（2）旋转矩阵是正交矩阵

观察R矩阵的每一行你会发现恰恰相反，比如旋转矩阵的第一行是坐标系{A}的x轴单位向量在坐标系{B}中的投影。如果把这个矩阵的每一行变成每一列，也就是对这个矩阵取转置，那么矩阵的三列是不是就分别代表坐标系{A}的三个单位矢量在坐标系{B}中的投影呢。用等式来表达那就是：

从这个等式中我们得到了另外一个结论：转置即逆。因此旋转矩阵是正交阵。另外一点因为旋转矩阵的每一列代表的都是某个坐标系x，y或者z轴的单位矢量在另一个坐标系下的表示。我们知道笛卡尔坐标系的三个坐标轴是相互正交的。从这一点上我们也可以得到转置即逆这个结论。

(3) 旋转矩阵的每一列都是单位向量

旋转矩阵的每一列都代表了某个坐标系的三个轴的单位矢量在其他坐标系下的投影。而实际上单位矢量是矢量本身的性质，与这个矢量在哪个坐标系下表达无关。因此旋转矩阵的每一列都是单位矢量。 以第一列为例，它分别是坐标系{B}的x轴单位矢量在坐标系{A}中的投影。如下图所示：

坐标系{B}的x轴单位矢量Xb的长度为1，也就是l = 1。而：

，同理

，

。那么旋转矩阵的第一列三个元素的平方和为：

从这一点上也可以说旋转矩阵的每一列都是单位向量（每一行也是单位向量）。
举例

理解了前面的几个性质之后，我相信我们可以比较轻松的解决这篇文章开头提出的问题了，坐标系{B}由坐标系{A}绕x轴旋转45度得到，旋转矩阵应该怎么写（坐标系{B}与坐标系{A}之间的姿态关系）？通过2.1中得出的结论我们可以一列一列地写出这个旋转矩阵。旋转矩阵的第一列代表了坐标系{B}的x轴在坐标系{A}中的表示。 由于坐标系{B}是坐标系{A}绕x轴旋转得到，因此两个坐标系的x轴是重合的。因此坐标系{B}的x轴只在坐标系{A}的x轴上有投影，在{A}的另外两个轴上没有投影（坐标轴正交的缘故）。因此旋转矩阵的第一列为：

旋转矩阵的第二列代表坐标系{B}的y轴在坐标系{A}中的投影，如下图所示。

根据简单的三角关系就可以得出第二列为：

同样的道理可以推导出第三列为：

至此就完成了旋转矩阵的列写。 这里只讨论了绕特殊轴的旋转，至于绕任意轴旋转任意角度的问题，在之后的文章中我们再讨论。 最后总结一下旋转矩阵的性质：旋转矩阵的本质是坐标轴单位向量的投影；旋转矩阵转置即逆；旋转矩阵的每一行，每一列都是单位向量

参考链接：https://www.bilibili.com/video/BV1KV411Z7sC/?p=4
参考链接：https://www.guyuehome.com/19079