SLAM : 旋转向量和旋转矩阵的互转换