C语言实现方向余弦矩阵转旋转矢量

方向余弦矩阵

方向余弦矩阵(Direction Cosine Matrix，DCM）又被称为“坐标转换矩阵”，常用于将矢量的投影从一个坐标系变换到另一坐标系中。方向余弦即与坐标轴夹角的余弦。

旋转矢量

力学中刚体的有限次转动是不可交换的。转动的不可交换性决定了转动不是矢量，即两次以上的不同轴转动不能相加。对一个空间方向随时间变化的角速度矢量进行积分是没有物理意义的。而旋转矢量破解了这个难题。一个坐标系到另一个坐标系的变换可以通过多次转动来完成，也可以通过绕一个定义在参考坐标系中的矢量的单次转动来实现。该矢量称作等效旋转矢量(rotation vector）是一个三元素的向量，旋转矢量的方向给出了转动轴的方向，它的模长为转动角度的大小。又称为轴角（axis-angle)。

源码

/* Convert direct cosine matirx to Rotation vector  ---------------------------------------------------------
* args   : double *m        I   matrix m (3 x 3)
*          double *rv       I   Rotation vector (3 x 1)
* re