fix stop velocity threshold

tier4 · Dec 15, 2023 · 87ef309 · 87ef309
1 parent b59f158
commit 87ef309
Showing 1 changed file with 1 addition and 1 deletion.
diff --git a/planning/obstacle_stop_planner/src/node.cpp b/planning/obstacle_stop_planner/src/node.cpp
@@ -663,7 +663,7 @@ void ObstacleStopPlannerNode::searchObstacle(
 
   const auto now = this->now();
 
-  if (current_velocity_ptr->twist.twist.linear.x == 0) {
+  if (std::fabs(current_velocity_ptr->twist.twist.linear.x) < 1e-9) {
     updateObstacleHistory(now);
   }