fix(log-messages): printing traffic light regulatory element id in warning messages where it is failed to receive signal and calculate stop point.

Signed-off-by: AhmedEbrahim <ahmed.a.d.ebrahim@gmail.com>

Author: ahmeddesokyebrahim

planning/behavior_velocity_traffic_light_module/src/scene.cpp

@@ -199,7 +199,7 @@ bool TrafficLightModule::modifyPathVelocity(PathWithLaneId * path, StopReason *
         input_path, lanelet_stop_lines,
         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");
+    RCLCPP_WARN_STREAM_THROTTLE(logger_, *clock_, 5000, "Failed to calculate stop point and insert index for regulatory element id " << traffic_light_reg_elem_.id());
     setSafe(true);
     setDistance(std::numeric_limits<double>::lowest());
     return false;
@@ -356,9 +356,9 @@ bool TrafficLightModule::findValidTrafficSignal(TrafficSignalStamped & valid_tra
   const auto traffic_signal_stamped_opt = planner_data_->getTrafficSignal(
     traffic_light_reg_elem_.id(), true /* traffic light module keeps last observation */);
   if (!traffic_signal_stamped_opt) {
-    RCLCPP_WARN_THROTTLE(
+    RCLCPP_WARN_STREAM_THROTTLE(
       logger_, *clock_, 5000 /* ms */,
-      "the traffic signal data associated with regulatory element id is not received");
+      "the traffic signal data associated with regulatory element id " << traffic_light_reg_elem_.id() << " is not received");
     return false;
   }
   valid_traffic_signal = traffic_signal_stamped_opt.value();