根据rodrigues公式求3×3 旋转矩阵 the rodrigues formula: http://en.wikipedia.org/wiki/Rodrigues _rotation_formula-According to rodrigues formula for 3 × 3 rotation matrix the rodrigues formula: http://en.wikipedia.org/wiki/Rodrigues _rotation_formula