绕固定坐标轴旋转与绕自身坐标轴旋转一致性证明

  最近在看人头姿态和视线方向检测的东西,需要考虑坐标系与坐标系之间的旋转.用欧拉角表示坐标系的旋转时存在两种旋转方法,另外旋转的顺序也会对旋转结果有影响,查了一些资料总结一下结果.
  描述坐标系$\text{B}$相对于坐标系$\text{A}$的姿态有两种方式:第一种是绕固定坐标轴旋转,第二种是绕自身坐标轴旋转.假设坐标系$\text{A}$为世界坐标系(不动),坐标系$\text{B}$为旋转坐标系,两个坐标系在开始时重合,则:

• 绕固定坐标轴旋转:

  先将$\text{B}$绕$\text{A}$的$\text{X}$轴旋转$\alpha$,再将$\text{B}$绕$\text{A}$的$\text{Y}$轴旋转$\beta$,最后将$\text{B}$绕$\text{A}$的$\text{Z}$轴旋转$\gamma$.旋转过程中坐标系$\text{A}$是不动的,其三个坐标轴也是固定的,因此称这种旋转方法为绕固定轴旋转.注意这里的旋转方向为先$\text{X}$轴,再$\text{Y}$轴,最后$\text{Z}$轴.

• 绕自身坐标轴旋转:

  先将$\text{B}$绕$\text{B}$的$\text{Z}$轴旋转$\gamma$,再将$\text{B}$绕$\text{B}$的$\text{Y}$轴旋转$\beta$,最后将$\text{B}$绕$\text{B}$的$\text{X}$轴旋转$\alpha$.旋转过程中坐标系$\text{B}$是变化的,其三个坐标轴也是变化的,称这种旋转方法为绕固自身旋转.注意这里的旋转方向为先$\text{Z}$轴,再$\text{Y}$轴,最后$\text{X}$轴.和第一种旋转方式的旋转顺序不同,原因是后面要给出的结论.

• 结论:

  以绕固定轴方式,先$\text{X}$轴转$\alpha$,再$\text{Y}$轴转$\beta$,最后$\text{Z}$轴转$\gamma$的旋转和以绕自身轴方式,先$\text{Z}$轴转$\gamma$,再$\text{Y}$轴转$\beta$,最后$\text{X}$轴转$\alpha$的旋转是等效的,下面给出"僵硬"的数学证明.

• 证明:

  我们知道,坐标轴的旋转可以用旋转矩阵来表示,为了证明上述两种旋转方法是等效的,只需要证明两种旋转方法对应的旋转矩阵是相同的.

  • 对于绕固定轴方式,先$\text{X}$轴转$\alpha$,再$\text{Y}$轴转$\beta$,最后$\text{Z}$轴转$\gamma$的旋转,其旋转矩阵$\text{R}$容易得到:

    $R_X(\alpha )=\left[\begin{array}{ccc}1& 0& 0\\ 0& cos(\alpha )& -sin(\alpha )\\ 0& sin(\alpha )& cos(\alpha )\end{array}\right]$

    $R_Y(\beta )=\left[\begin{array}{ccc}cos(\beta )& 0& sin(\beta )\\ 0& 1& 0\\ -sin(\beta )& 0& cos(\beta )\end{array}\right]$

    $R_Z(\gamma )=\left[\begin{array}{ccc}cos(\gamma )& -sin(\gamma )& 0\\ sin(\gamma )& cos(\gamma )& 0\\ 0& 0& 1\end{array}\right]$

    $$\begin{gathered} \text{R}=R_Z(\gamma )\times R_Y(\alpha )\times R_X(\alpha )= \\ \left[\begin{array}{ccc}cos(\beta )cos(\gamma )& sin(\alpha )sin(\beta )cos(\gamma )-cos(\alpha )sin(\gamma )& cos(\alpha )sin(\beta )cos(\gamma )+sin(\alpha )sin(\gamma )\\ cos(\beta )sin(\gamma )& sin(\alpha )sin(\beta )sin(\gamma )+cos(\alpha )cos(\gamma )& cos(\alpha )sin(\beta )sin(\gamma )-sin(\alpha )cos(\gamma )\\ -sin(\beta )& sin(\alpha )cos(\gamma )& cos(\alpha )cos(\gamma )\end{array}\right] \end{gathered}$$

  • 对于绕自身轴方式,先$\text{Z}$轴转$\gamma$,再$\text{Y}$轴转$\beta$,最后$\text{X}$轴转$\alpha$的旋转,其旋转矩阵$\text{R}$.首先给出坐标系绕任意以单位向量表示方向的定轴$(x,y,z)$旋转$\theta$的旋转矩阵为:

    $\text{r}=\left[\begin{array}{ccc}cos(\theta )+(1-cos(\theta ))x^2& (1-cos(\theta ))xy-sin(\theta )z& (1-cos(\theta ))xz+sin(\theta )y\\ (1-cos(\theta ))xy+sin(\theta )z& cos(\theta )+(1-cos(\theta ))y^2& (1-cos(\theta ))yz-sin(\theta )x\\ (1-cos(\theta ))xz-sin(\theta )y& (1-cos(\theta ))yz+sin(\theta )x& cos(\theta )+(1-cos(\theta ))z^2\end{array}\right]$

    则先$\text{Z}$轴转$\gamma$对应的旋转矩阵$R_Z(\gamma )$:

    $R_Z(\gamma )=\left[\begin{array}{ccc}cos(\gamma )& -sin(\gamma )& 0\\ sin(\gamma )& cos(\gamma )& 0\\ 0& 0& 1\end{array}\right]$

    旋转后的$\text{Y}$轴由$(0,1,0)$变成了$(-sin(\gamma ),cos(\gamma ),0)$,再按照绕任意轴的公式计算得到绕此时的$\text{Y}$轴旋转$\beta$对应的旋转矩阵为:

    $R_Y(\beta )=\left[\begin{array}{ccc}cos(\beta )-si{n}^2(\gamma )(cos(\beta )-1)& cos(\gamma )sin(\gamma )(cos(\beta )-1)& sin(\beta )cos(\gamma )\\ cos(\gamma )sin(\gamma )(cos(\beta )-1)& cos(\beta )-co{s}^2(\gamma )(cos(\beta )-1)& sin(\beta )sin(\gamma )\\ -sin(\beta )cos(\gamma )& -sin(\beta )sin(\gamma )& cos(\beta )\end{array}\right]$

    则两步旋转后的旋转矩阵为$R_Y(\beta )\times R_Z(\gamma )$:

    $R_Y(\beta )\times R_Z(\gamma )=\left[\begin{array}{ccc}cos(\beta )cos(\gamma )& -sin(\gamma )& sin(\beta )cos(\gamma )\\ cos(\beta )sin(\gamma )& cos(\gamma )& sin(\beta )sin(\gamma )\\ -sin(\beta )& 0& cos(\beta )\end{array}\right]$

    旋转后的$\text{X}$轴由$(1,0,0)$变成了$(cos(\beta )cos(\gamma ),-sin(\gamma ),sin(\beta )cos(\gamma ))$,再按照绕任意轴的公式计算得到绕此时的$\text{X}$轴旋转$\alpha$对应的旋转矩阵为$R_X(\alpha )$:

    这个矩阵实在太长了我不想写了,反正就是按照上面的任意轴公式,把$x=cos(\beta )cos(\gamma ),y=-sin(\gamma ),z=sin(\beta )cos(\gamma )$和$\theta =\gamma$往里一代就行了.

    最后总的旋转矩阵$\text{R}=R_X(\alpha )\times R_Y(\beta )\times R_Z(\gamma )$ ,把各部的结果代进去一算,就得到了最终结果:

    $\text{R}=\left[\begin{array}{ccc}cos(\beta )cos(\gamma )& sin(\alpha )sin(\beta )cos(\gamma )-cos(\alpha )sin(\gamma )& cos(\alpha )sin(\beta )cos(\gamma )+sin(\alpha )sin(\gamma )\\ cos(\beta )sin(\gamma )& sin(\alpha )sin(\beta )sin(\gamma )+cos(\alpha )cos(\gamma )& cos(\alpha )sin(\beta )sin(\gamma )-sin(\alpha )cos(\gamma )\\ -sin(\beta )& sin(\alpha )cos(\gamma )& cos(\alpha )cos(\gamma )\end{array}\right]$

    和第一种旋转方法得到的结果相同.于是证明了前面给出的结论.之所以说这是一种很"僵硬"的证明办法,是因为整个过程是用matlab强行代公式计算出来的,中间结果可能看起来很啰嗦式子很长,但是你把他们都乘起来,就能化简出相同的结果.实际上应该有更优雅的立体几何投影证明方法,但是空间想象能力实在太差,想不出来.如果有清楚的朋友请指点一下.

• 经过和泡儿鱼的讨论,想出了比较简洁的证明方法,写在下面:

  • 证明2:

    旋转矩阵可以用来表示坐标系和坐标系之间旋转的变换关系,也可以用来表示同一个坐标系下坐标旋转前后的变换关系,从后者的角度出发可以得到一个比较简洁又清晰的证明方法.

    我们的任务是证明:以绕固定轴方式,先绕$\text{X}$轴转$\alpha$,再绕$\text{Y}$轴转$\beta$,最后绕$\text{Z}$轴转$\gamma$的旋转和以绕自身轴方式,先绕$\text{Z}$轴转$\gamma$,再绕$\text{Y}$轴转$\beta$,最后绕$\text{X}$轴转$\alpha$的旋转是等效的.在上述僵硬的证明方法中,我们通过计算证明了两种方式下坐标系前后的变换矩阵是相同的.下面的方法中,我们证明A坐标系中有一个向量,按照这两种方式去旋转,旋转后它们在原A坐标系下转到了同一个位置,即证明了上述结论.

    假设有一个固定的世界坐标系$\text{A}$,其中有一个向量$\text{a}$,它在$\text{A}$中的坐标为$\text{Ra}$.

    • 对于第一种方式的变换:

      向量$\text{a}$先绕$\text{A}$的$\text{X}$轴转$\alpha$,再绕$\text{A}$的$\text{Y}$轴转$\beta$,最后绕$\text{A}$的$\text{Z}$轴转​$\gamma$,则三步旋转过后它在坐标系$\text{A}$中的坐标:

      $\text{Ra’}=R_Z(\gamma )\times R_Y(\alpha )\times R_X(\alpha )\times \text{Ra}$

      其中:

      $R_X(\alpha )=\left[\begin{array}{ccc}1& 0& 0\\ 0& cos(\alpha )& -sin(\alpha )\\ 0& sin(\alpha )& cos(\alpha )\end{array}\right]$

      $R_Y(\beta )=\left[\begin{array}{ccc}cos(\beta )& 0& sin(\beta )\\ 0& 1& 0\\ -sin(\beta )& 0& cos(\beta )\end{array}\right]$

      $R_Z(\gamma )=\left[\begin{array}{ccc}cos(\gamma )& -sin(\gamma )& 0\\ sin(\gamma )& cos(\gamma )& 0\\ 0& 0& 1\end{array}\right]$

    • 对于第二种方式的变换:

      假设除了不动的世界坐标系$\text{A}$以外,还有一个和向量$\text{a}$固连在一起的向量坐标系$\text{B}$.固连的向量坐标系和向量$\text{a}$是固连的不会产生相对运动,即向量$\text{a}$怎么转固连坐标系$\text{B}$就怎么转.那么显然,任何转动后,向量$\text{a}$在固连坐标系$\text{B}$下的坐标都是不变的,且始终等于未发生任何转动时向量$\text{a}$在世界坐标系$\text{A}$下的坐标$\text{Ra}$.

      第二种方式的变换为:向量$\text{a}$先绕$\text{B}$的$\text{Z}$轴转$\gamma$,再绕$\text{B}$的$\text{Y}$轴转$\beta$,最后绕$\text{B}$的$\text{X}$轴转$\alpha$,将转动步骤倒过来叙述更方便

      • 对于第三步转动,即向量$\text{a}$绕第二次转动后的固连坐标系$\text{B”}$的$\text{X}$轴转$\alpha$,有:

        $\text{Ra2}=R_X(\alpha )\times \text{Ra3}$

        其中$\text{Ra2}$为三次转动后向量$\text{a}$在第二次转动后的固连坐标系$\text{B”}$中的坐标,$\text{Ra3}$为三次转动后向量$\text{a}$在第三次转动后的固连坐标系$\text{B”’}$中的坐标.$R_X(\alpha )$为第二次转动后的固连坐标系$\text{B”}$和第三次转动后的固连坐标系$\text{B”’}$之间的旋转矩阵.由于第三次旋转就是绕着$\text{B”}$的$\text{X}$轴转了$\alpha$,因此$R_X(\alpha )$,或者说$\text{B”}$和$\text{B”’}$之间的变换矩阵就是:

        $R_X(\alpha )=\left[\begin{array}{ccc}1& 0& 0\\ 0& cos(\alpha )& -sin(\alpha )\\ 0& sin(\alpha )& cos(\alpha )\end{array}\right]$

      • 同理对于第二步转动,有:

        $\text{Ra1}=R_Y(\beta )\times \text{Ra2}$ ,各变量的意义类似第三步不再赘述.

        $R_Y(\beta )=\left[\begin{array}{ccc}cos(\beta )& 0& sin(\beta )\\ 0& 1& 0\\ -sin(\beta )& 0& cos(\beta )\end{array}\right]$

      • 同理对于第一步转动有:

        $\text{Ra0}=R_Z(\gamma )\times \text{Ra1}$,其中$\text{Ra0}$为三次转动后向量$\text{a}$在第0次转动后的固连坐标系$\text{B”}$中的坐标,也就是在世界坐标系中的坐标$\text{Ra’}$,即:

        $\text{Ra’}=R_Z(\gamma )\times \text{Ra1}$,其中:

        $R_Z(\gamma )=\left[\begin{array}{ccc}cos(\gamma )& -sin(\gamma )& 0\\ sin(\gamma )& cos(\gamma )& 0\\ 0& 0& 1\end{array}\right]$

      • 把三步转动穿起来看,有:

        $$\begin{gathered} \text{Ra’}=R_Z(\gamma )\times \text{Ra1}=R_Z(\gamma )\times (R_Y(\beta )\times \text{Ra2})=R_Z(\gamma )\times (R_Y(\beta )\times (R_X(\alpha )\times \text{Ra3}))= \\ {R}_Z(\gamma )\times R_Y(\beta )\times R_X(\alpha )\times \text{Ra3} \end{gathered}$$

        又因为$\text{Ra3}$是第三次转动后向量$\text{a}$在第三次转动后的固连坐标系$\text{B”’}$的坐标,由于相对位置不变,这个值就等于未发生转动时向量$\text{a}$在世界坐标系$\text{A}$中的坐标,即:

        $\text{Ra3}=\text{Ra}$,则有:

        $\text{Ra’}=R_Z(\gamma )\times R_Y(\alpha )\times R_X(\alpha )\times \text{Ra3}=R_Z(\gamma )\times R_Y(\alpha )\times R_X(\alpha )\times \text{Ra}$与第一种方式的变换结果相同.即同一个向量经过两种方式的变换后在世界坐标系中的坐标相同,也证明了这两种变换是等效的.

  总结一下就是,如果是坐标系或者向量绕着固定的坐标轴旋转,相当于每转一次产生一个旋转矩阵,然后按旋转顺序将这些旋转矩阵左乘起来.如果是坐标系或者向量绕着自身的坐标轴旋转,相当于每转一次产生一个旋转矩阵,然后按旋转顺序将这些矩阵右乘起来.要注意后者的每一步旋转产生的旋转矩阵,不要以世界坐标系为基准去算,而是以每次旋转前的坐标系去算,也就是每次旋转矩阵只描述当前这次旋转前后的坐标系之间的转换矩阵!!!

  费了半天劲希望把事情说明白了,我其实很担心哪个地方有笔误没写清楚,如果有的话请帮忙指出来.谢谢!

  网上也找到了其他类似的证明方法,看起来似乎更简洁也更容易理解,贴出来供参考:

  blog.miskcoo.com/2016/12/rotation-in-3d-space