From 6b1e0a7110592da8db479cf6dff1d859232a713a Mon Sep 17 00:00:00 2001
From: Zulfaqar Azmi <zulfaqar.azmi@tier4.jp>
Date: Mon, 18 Dec 2023 14:28:25 +0900
Subject: [PATCH] add debug

Signed-off-by: Zulfaqar Azmi <zulfaqar.azmi@tier4.jp>
---
 .../src/scene.cpp                                         | 8 ++++++++
 1 file changed, 8 insertions(+)

diff --git a/planning/behavior_path_avoidance_by_lane_change_module/src/scene.cpp b/planning/behavior_path_avoidance_by_lane_change_module/src/scene.cpp
index 4d4baaa0e42d3..619cbc515f816 100644
--- a/planning/behavior_path_avoidance_by_lane_change_module/src/scene.cpp
+++ b/planning/behavior_path_avoidance_by_lane_change_module/src/scene.cpp
@@ -20,6 +20,8 @@
 #include "behavior_path_planner_common/utils/path_utils.hpp"
 #include "behavior_path_planner_common/utils/utils.hpp"
 
+#include <rclcpp/logging.hpp>
+
 #include <boost/geometry/algorithms/centroid.hpp>
 #include <boost/geometry/strategies/cartesian/centroid_bashein_detmer.hpp>
 
@@ -103,6 +105,12 @@ bool AvoidanceByLaneChange::specialRequiredCheck() const
 
   const auto maximum_avoid_distance = avoidance_helper_->getMaxAvoidanceDistance(shift_length);
 
+  RCLCPP_DEBUG(
+    logger_,
+    "nearest_object.longitudinal %.3f, minimum_lane_change_length %.3f, maximum_avoid_distance "
+    "%.3f",
+    nearest_object.longitudinal, minimum_lane_change_length, maximum_avoid_distance);
+
   return nearest_object.longitudinal > std::max(minimum_lane_change_length, maximum_avoid_distance);
 }