微信公众号搜"智元新知"关注
微信扫一扫可直接关注哦!

估计相机姿势时波动太大,使用 Apriltag 和 3 x 3 旋转姿势矩阵的逆

如何解决估计相机姿势时波动太大,使用 Apriltag 和 3 x 3 旋转姿势矩阵的逆

首先,我在解释,我在做什么,

我正在使用 apriltag c++ python 包装器来估计 TAG 的姿势。 输出是姿势 3 x 3 旋转矩阵和 4 x 1 平移矩阵。

现在,我正在执行 3 x 3 旋转矩阵的逆运算,并通过以下等式计算新的相机姿势。

Cam_X = (R[0][0]*Tag_x) + (R[0][1]*Tag_y) + (R[0][2]*Tag_z) 
Cam_Y = (R[1][0]*Tag_x) + (R[1][1]*Tag_y) + (R[1][2]*Tag_z)
Cam_Z = (R[2][0]*Tag_x) + (R[2][1]*Tag_y) + (R[2][2]*Tag_z) 

相机校准良好,标签坐标的实际精度低于误差的 5%。 但是Cam_X、Cam_Y、Cam_Z的结果波动太大,同时tag在天花板上,所以我的Apriltag超级稳定(0自由度,刚体)。

有人可以帮忙解决这个基本问题, 感谢您的努力。

上述等式的参考:[1] [1]:https://github.com/ColumnRobotics/column/blob/master/src/rectified_april_tag.cpp

版权声明:本文内容由互联网用户自发贡献,该文观点与技术仅代表作者本人。本站仅提供信息存储空间服务,不拥有所有权,不承担相关法律责任。如发现本站有涉嫌侵权/违法违规的内容, 请发送邮件至 dio@foxmail.com 举报,一经查实,本站将立刻删除。