点绕坐标系旋转旋转矩阵推导、理解

点绕坐标系旋转旋转矩阵推导、理解

开会过程中，翻笔记本时突然发现了之前推导的点绕坐标系旋转的旋转矩阵求解过程。在直觉上，一个点绕3个坐标轴旋转的旋转矩阵在形式上看起来是一致的，观感上比较优雅、整齐，但是一直没有仔细观察背后的原理。因此又对这个过程进行了一次推导，对这种整齐有了更深的理解，同时对记忆也有所帮助。特此记录。

由于我们提到三维坐标系时，常用XYZ三个字母代替3个轴，为了不失一般性，避免字母先入为主产生的印象，在这里用UVW来指代右手三维坐标系。

大拇指指向轴线方向，四指方向为旋转的正方向

如下图所示。 坐标系UVW为右手坐标系，一个点绕W轴旋转$\theta$角度前后的坐标为$(U^{{}^{\prime }},V^{{}^{\prime }})--->(U,V)$ 求解旋转后的坐标(旋转矩阵)。

为了方便求解，定义2个中间变量$R,\delta$，R表示点到原点的距离，在旋转前后，点到原点的距离不变。
则有下列公式成立：

$$\{\begin{array}{r}{U}^{{}^{\prime }}=R\ast cos\delta \\ V^{{}^{\prime }}=R\ast sin\delta \end{array}\text{\hspace{1em}(1)}$$
$$\{\begin{array}{r}U=R\ast cos(\delta +\theta )=R\ast (cos\delta cos\theta -sin\delta sin\theta )\\ V=R\ast sin(\delta +\theta )=R\ast (sin\delta cos\theta +cos\delta sin\theta )\end{array}\text{\hspace{1em}(2)}$$
将式(1)和式(2)结合：
$$\{\begin{array}{r}U=R\ast (cos\delta cos\theta -sin\delta sin\theta )=U^{{}^{\prime }}cos\theta -V^{{}^{\prime }}sin\theta \\ V=R\ast (sin\delta cos\theta +cos\delta sin\theta )=U^{{}^{\prime }}sin\theta +V^{{}^{\prime }}cos\theta \end{array}\text{\hspace{1em}(3)}$$
旋转前后点的W坐标不变，那么旋转后点的坐标可表示如下：
$$\{\begin{array}{rl}U& =U^{{}^{\prime }}cos\theta -V^{{}^{\prime }}sin\theta \\ V& =U^{{}^{\prime }}sin\theta +V^{{}^{\prime }}cos\theta \\ W& =W^{{}^{\prime }}\end{array}\text{\hspace{1em}(4)}$$
将上面写为矩阵的形式：
$$\left[\begin{array}{c}U\\ V\\ W\end{array}\right]=\left[\begin{array}{ccc}cos\theta & -sin\theta & 0\\ sin\theta & cos\theta & 0\\ 0& 0& 1\end{array}\right]\left[\begin{array}{c}{U}^{{}^{\prime }}\\ V^{{}^{\prime }}\\ W^{{}^{\prime }}\end{array}\right]\text{\hspace{1em}(5)}$$
将式(5)与图坐标系图放在一起进行考虑，如下图所示：

矩阵的第1行为旋转正方向的起点轴，第2行为旋转正方向的终点轴,第3行为旋转轴.

---

按照上面说明,我们在来回退到常用的XYZ代号的坐标系中.
1.点绕Z轴旋转,那么旋转正方向是由X指向Y,因此在上面图中,将UV分别替换为X,Y,W替换为Z,可得:
$$\left[\begin{array}{c}X\\ Y\\ Z\end{array}\right]=\left[\begin{array}{ccc}cos\theta & -sin\theta & 0\\ sin\theta & cos\theta & 0\\ 0& 0& 1\end{array}\right]\left[\begin{array}{c}{X}^{{}^{\prime }}\\ Y^{{}^{\prime }}\\ Z^{{}^{\prime }}\end{array}\right]\text{\hspace{1em}(6)}$$
2.点绕Y轴旋转,那么旋转正方向是由Z指向X,因此在上面图中,将UV分别替换为Z,X,W替换为Y,可得:
$$\left[\begin{array}{c}Z\\ X\\ Y\end{array}\right]=\left[\begin{array}{ccc}cos\theta & -sin\theta & 0\\ sin\theta & cos\theta & 0\\ 0& 0& 1\end{array}\right]\left[\begin{array}{c}{Z}^{{}^{\prime }}\\ X^{{}^{\prime }}\\ Y^{{}^{\prime }}\end{array}\right]\text{\hspace{1em}(7)}$$
将上式展开,然后调整顺序并整理,可得:

$$\left[\begin{array}{c}X\\ Y\\ Z\end{array}\right]=\left[\begin{array}{ccc}cos\theta & 0& sin\theta \\ 0& 1& 0\\ -sin\theta & 0& cos\theta \end{array}\right]\left[\begin{array}{c}{X}^{{}^{\prime }}\\ Y^{{}^{\prime }}\\ Z^{{}^{\prime }}\end{array}\right]\text{\hspace{1em}(8)}$$
3.点绕X轴旋转,那么旋转正方向是由Y指向Z,因此在上面图中,将UV分别替换为Y,Z,W替换为X,可得:
$$\left[\begin{array}{c}Y\\ Z\\ X\end{array}\right]=\left[\begin{array}{ccc}cos\theta & -sin\theta & 0\\ sin\theta & cos\theta & 0\\ 0& 0& 1\end{array}\right]\left[\begin{array}{c}{Y}^{{}^{\prime }}\\ Z^{{}^{\prime }}\\ X^{{}^{\prime }}\end{array}\right]\text{\hspace{1em}(9)}$$
将上式展开,然后调整顺序并整理,可得:
$$\left[\begin{array}{c}X\\ Y\\ Z\end{array}\right]=\left[\begin{array}{ccc}1& 0& 0\\ 0& cos\theta & -sin\theta \\ 0& sin\theta & cos\theta \end{array}\right]\left[\begin{array}{c}{X}^{{}^{\prime }}\\ Y^{{}^{\prime }}\\ Z^{{}^{\prime }}\end{array}\right]\text{\hspace{1em}(10)}$$

综上,可以方便记忆坐标系中一个点绕X,Y,Z三轴的旋转矩阵.