把solvepnp得到的旋转向量和平移向量转换成旋转矩阵(SE(3))