UZ-SLAMLab / ORB_SLAM3

ORB-SLAM3: An Accurate Open-Source Library for Visual, Visual-Inertial and Multi-Map SLAM
GNU General Public License v3.0
6.64k stars 2.57k forks source link

question about the variable avgA in class IMU::Preintegrated #889

Open Cai-RS opened 6 months ago

Cai-RS commented 6 months ago

Hello, thanks for your great work! I found that in Tracking::StereoInitialization() function, the two variables avgA of mCurrentFrame and mLastFrame are compared to decide whether the acceleration between first 2 image frames is enough. image

However, it seems that variable avgA is the (time) weightd average of IMU acceleration data (have to subtract the bias) between every two images (image A and image B), and it is in the IMU coordinate system at the initial moment of the pre-integration (that is, the moment of image A). image

So the problem is, how to subtract two vectors that are not in the same coordinate system? Did you forget to transform avgA to the common coordinate system (for example, the IMU coordinate system at the moment of first image in all system)?

WFram commented 5 months ago

All the accelerations are in the same frame; dR is used to transform accelerations.