hku-mars / FAST_LIO

A computationally efficient and robust LiDAR-inertial odometry (LIO) package
GNU General Public License v2.0
2.78k stars 936 forks source link

发布的odometry的坐标系 #218

Closed PengKunPROO closed 1 year ago

PengKunPROO commented 1 year ago

请问一下代码中odomAftMapped这个里面存储的四元数和位置向量都是关于世界坐标系(即第一帧IMU的body坐标系)吗?

WFram commented 1 year ago

Yes. Because to create the odometry message, the pose it taken directly from the current EKF state. And the EKF state stores a transformation from IMU frame to the World frame (IMU -> World), as stated in the paper (III-C). Also, it's clear from the functions that transform points to the world frame.

stale[bot] commented 1 year ago

This issue has been automatically marked as stale because it has not had recent activity. It will be closed if no further activity occurs. Thank you for your contributions.