刚性位置变化计算，输入物体在空间坐标系中的坐标，以及旋转向量和平移向量，计算其在摄像机坐标系中的坐标。- [Y,dYdom,dYdT] = rigid_motion(X,om,T) Computes the rigid motion transformation Y = R*X+T, where R = rodrigues(om). INPUT: X: 3D structure in the world coordinate frame (3xN matrix for

旋转向量与旋转矩阵转化(罗德里格斯 ) 根据OPENCV里的 cvRodrigues2()函数原理编写的纯c的函数，不需要依赖OPENCV-Rotation vector and rotation matrix transformation (Rodriguez)