Merge pull request #1578 from tier4/fix-a-mini-bug

fix(planning_debug_tools): fix a bug of perception reproducer
tier4 · Oct 4, 2024 · 128f9fb · 128f9fb
2 parents 5e7f763 + a00f7b2
commit 128f9fb
Showing 1 changed file with 6 additions and 2 deletions.
diff --git a/planning/planning_debug_tools/scripts/perception_replayer/perception_reproducer.py b/planning/planning_debug_tools/scripts/perception_replayer/perception_reproducer.py
@@ -176,8 +176,12 @@ def on_timer(self):
                 (ego_pose.position.x - ego_odom_msg.pose.pose.position.x) ** 2
                 + (ego_pose.position.y - ego_odom_msg.pose.pose.position.y) ** 2
             )
-            repeat_flag = ego_rosbag_speed > ego_speed * 5 and ego_rosbag_dist > 1.0
-            # set the speed threshold to many (5) times then ego_speed because this constraint is mainly for departing/stopping (ego speed is close to 0).
+            repeat_flag = (
+                ego_rosbag_speed > ego_speed * 2
+                and ego_rosbag_speed > 3.0
+                and ego_rosbag_dist > self.ego_odom_search_radius
+            )
+            # if ego_rosbag_speed is too fast than ego_speed, stop publishing the rosbag's ego odom message temporarily.
 
         if not repeat_flag:
             self.stopwatch.tic("find_topics_by_timestamp")