0

我已经确定了绝对姿势。我确实有一系列相对姿势。我想根据两者的组合来确定当前的相机姿势。我正在使用以下代码来执行此操作

Matrix4x4 displacement =  initial_rel_pose.inverse * current_rel_pose;

Matrix4x4 current_pose = absolute_pose * displacement;

initial_rel_pose是第一个姿势,而current_rel_pose是此时的相对姿势。最后,我将位移与之前估计的绝对位姿相乘以确定当前位姿。不幸的是,位置和旋转最初是正确的,但最终是错误的。我究竟做错了什么?

4

0 回答 0