diff --git a/src/modelec_strat/src/enemy_manager.cpp b/src/modelec_strat/src/enemy_manager.cpp index 354bb14..756c68e 100644 --- a/src/modelec_strat/src/enemy_manager.cpp +++ b/src/modelec_strat/src/enemy_manager.cpp @@ -84,6 +84,8 @@ namespace Modelec void EnemyManager::OnLidarData(const sensor_msgs::msg::LaserScan::SharedPtr msg) { + is_enemy_close_ = false; + if (std::isnan(current_pos_.x) || std::isnan(current_pos_.y)) { RCLCPP_WARN(this->get_logger(), "Current robot position unknown, cannot compute enemy position"); @@ -186,7 +188,7 @@ namespace Modelec if (min_distance < std::numeric_limits::max()) { - is_enemy_close_ = false; + if (is_enemy_close_) return; modelec_interfaces::msg::OdometryPos enemy_pos; enemy_pos.x = best_x;