坐标对齐(估计值-真实值)

来源:互联网 发布:男生的小秘密 知乎 编辑:程序博客网 时间:2024/06/06 14:02

主要解决跑数据集的时候,自己的pose的坐标和真实值的pose坐标不一致问题(并不是简单的一个坐标转换的事情)。

本代码只需要你slam估计的数据和真实数据(数据格式是:time,x,y,z,q_x,q_y,q_x,q_w  ) (  旋转是以四元数形式保存的)

代码我已经上传的GitHub上:https://github.com/QingfengLi-hit/coordinate_align

0 0
原创粉丝点击