OpenCV -SolvePNP如何从世界坐标计算猜测

时间:2018-06-16 18:18:30

标签: c++ opencv math rotation algebra

对于cv :: SolvePNP,我想提供翻译和旋转的初始猜测。 对于猜测,我在世界空间中进行平移,并将旋转作为向上和方向向量(或欧拉角)。 我们如何将世界空间平移和向上/方向向量转换为正确的格式,以便cv :: SolvePNP可以在正确的坐标系中使用它作为正确的猜测?

我使用useExtrinsicGuess = true,并提供tvec和rvec。

我从向上和向量向量计算了一个旋转矩阵,尽管似乎有不同的约定。 然后将Rodrigues的旋转矩阵转换为rvec。 我们用 Tvec = -R * worldspace_tvec。 然而,结果显然是不正确的,因为一旦将其转换回欧拉/世界空间转换,猜测将得到的tvec和rvec置于不同的位置。 从上/向量矢量和世界空间转换到SolvePNP的正确tvec和rvec输入是否有快速的方法?

提前致谢。

0 个答案:

没有答案