From ea59cdd24c26a737a85d0b0351fc0a3db5f7f928 Mon Sep 17 00:00:00 2001
From: Fumiya Watanabe <rej55.g@gmail.com>
Date: Thu, 28 Jul 2022 14:01:14 +0900
Subject: [PATCH] fix(behavior_velocity_planner): fix distance for traffic
 light module

Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com>
---
 .../src/scene_module/traffic_light/scene.cpp                    | 2 ++
 1 file changed, 2 insertions(+)

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
index fe3090f42ab68..516704d47be22 100644
--- a/planning/behavior_velocity_planner/src/scene_module/traffic_light/scene.cpp
+++ b/planning/behavior_velocity_planner/src/scene_module/traffic_light/scene.cpp
@@ -228,6 +228,8 @@ bool TrafficLightModule::modifyPathVelocity(
         planner_param_.stop_margin + planner_data_->vehicle_info_.max_longitudinal_offset_m,
         planner_data_->stop_line_extend_length, stop_line_point, stop_line_point_idx)) {
     RCLCPP_WARN_THROTTLE(logger_, *clock_, 5000, "Failed to calculate stop point and insert index");
+    setSafe(true);
+    setDistance(std::numeric_limits<double>::lowest());
     return false;
   }