feat(behavior_velocity_planner): output stop reason of traffic light …

…whenever a stop point is inserted (autowarefoundation#2323) Signed-off-by: tomoya.kimura <tomoya.kimura@tier4.jp> Signed-off-by: tomoya.kimura <tomoya.kimura@tier4.jp> Signed-off-by: kminoda <koji.minoda@tier4.jp>
kminoda · Jan 6, 2023 · e7f900d · e7f900d
1 parent 091860b
commit e7f900d
Showing 1 changed file with 2 additions and 1 deletion.
diff --git a/planning/behavior_velocity_planner/src/scene_module/traffic_light/scene.cpp b/planning/behavior_velocity_planner/src/scene_module/traffic_light/scene.cpp
@@ -489,8 +489,9 @@ autoware_auto_planning_msgs::msg::PathWithLaneId TrafficLightModule::insertStopP
   if (debug_data_.highest_confidence_traffic_light_point != std::nullopt) {
     stop_factor.stop_factor_points = std::vector<geometry_msgs::msg::Point>{
       debug_data_.highest_confidence_traffic_light_point.value()};
-    planning_utils::appendStopReason(stop_factor, stop_reason);
   }
+  planning_utils::appendStopReason(stop_factor, stop_reason);
+
   return modified_path;
 }