From e80051698c834c297ea0793ef087057d5fdd8b74 Mon Sep 17 00:00:00 2001 From: acki Date: Tue, 27 May 2025 21:20:58 -0400 Subject: [PATCH] MORE LOG --- src/modelec_strat/src/enemy_manager.cpp | 6 ++++++ 1 file changed, 6 insertions(+) diff --git a/src/modelec_strat/src/enemy_manager.cpp b/src/modelec_strat/src/enemy_manager.cpp index 96adf6a..6814d6b 100644 --- a/src/modelec_strat/src/enemy_manager.cpp +++ b/src/modelec_strat/src/enemy_manager.cpp @@ -101,12 +101,16 @@ namespace Modelec if (std::isnan(range) || range < msg->range_min || range > msg->range_max) { + RCLCPP_INFO(this->get_logger(), "Ignoring Lidar point with invalid range: %.2f", range); + angle += msg->angle_increment; continue; } if (range < robot_radius_) { + RCLCPP_INFO(this->get_logger(), "Ignoring Lidar point too close to robot: range=%.2f", range); + angle += msg->angle_increment; continue; } @@ -122,6 +126,8 @@ namespace Modelec // Ignore points outside of the table if (x_global < 0 || x_global > map_width_ || y_global < 0 || y_global > map_height_) { + RCLCPP_INFO(this->get_logger(), "Lidar point out of bounds: x=%.2f, y=%.2f", x_global, y_global); + angle += msg->angle_increment; continue; }