koide3 / glim

GLIM: versatile and extensible range-based 3D localization and mapping framework
MIT License
568 stars 76 forks source link

imu_cursor is not used in loose_initial_state_estimation.cpp #116

Open KOKIAOKI opened 2 days ago

KOKIAOKI commented 2 days ago

Describe the bug Hello! koide3! Thank you for your support always.

I wonder why imu_cursor is not used for imu_data in this line.

const Eigen::Vector3d acc_local = imu_data[i].middleRows<3>(1);

To Reproduce Is the following correct?

const Eigen::Vector3d acc_local = imu_data[imu_cursor].middleRows<3>(1);

Then, run to check

ros2 run glim_ros glim_rosbag [bag file]

Expected behavior I think this will correct the estimation of the direction of gravitational acceleration while moving.

Screenshots I haven't seen any differences in the test data, but I'll update if I find any changes in other data.

Environment (please complete the following information):

Additional context