fix: fix bug in previous code

Signed-off-by: vividf <[email protected]>
autowarefoundation · Jun 27, 2024 · 9fef37b · 9fef37b
1 parent e969356
commit 9fef37b
Showing 1 changed file with 4 additions and 2 deletions.
diff --git a/sensing/pointcloud_preprocessor/src/distortion_corrector/distortion_corrector.cpp b/sensing/pointcloud_preprocessor/src/distortion_corrector/distortion_corrector.cpp
@@ -37,8 +37,9 @@ void DistortionCorrector<Derived>::processTwistMessage(
       rclcpp::Time(twist_queue_.front().header.stamp) <
       rclcpp::Time(twist_msg->header.stamp) - rclcpp::Duration::from_seconds(1.0)) {
       twist_queue_.pop_front();
+    } else {
+      break;
     }
-    break;
   }
 }
 
@@ -109,8 +110,9 @@ void DistortionCorrector<Derived>::enqueueIMU(
       rclcpp::Time(angular_velocity_queue_.front().header.stamp) <
       rclcpp::Time(imu_msg->header.stamp) - rclcpp::Duration::from_seconds(1.0)) {
       angular_velocity_queue_.pop_front();
+    } else {
+      break;
     }
-    break;
   }
 }