opencv - 计算前向量并查看向量

Question

我有一个形状为 4x4 的齐次矩阵。如何从齐次矩阵中检索前向量和查看向量？

以下是我的齐次矩阵，

pose = np.array([ 0.23522,-7.0289e-17,-0.97194,-129.54,
0.97194,-7.3988e-17,0.23522,59.464,
-8.8446e-17,-1,5.0913e-17,2.11,
0,0,0,1]).reshape(4,4)

Answer 1

由于我还不能发表任何评论，我会发布这个作为答案。看看这个教程。这是你需要的吗？