fix erase of old imu messages

rpng · Jan 11, 2024 · 60ac071 · 60ac071
1 parent e84c8ca
commit 60ac071
Showing 1 changed file with 1 addition and 1 deletion.
diff --git a/ov_init/src/init/InertialInitializer.cpp b/ov_init/src/init/InertialInitializer.cpp
@@ -61,7 +61,7 @@ void InertialInitializer::feed_imu(const ov_core::ImuData &message, double oldes
   if (oldest_time != -1) {
     auto it0 = imu_data->begin();
     while (it0 != imu_data->end()) {
-      if (message.timestamp < oldest_time) {
+      if (it0->timestamp < oldest_time) {
         it0 = imu_data->erase(it0);
       } else {
         it0++;