diff --git a/src/modelec_strat/src/enemy_manager.cpp b/src/modelec_strat/src/enemy_manager.cpp index d59b1c5..354bb14 100644 --- a/src/modelec_strat/src/enemy_manager.cpp +++ b/src/modelec_strat/src/enemy_manager.cpp @@ -146,15 +146,13 @@ namespace Modelec emergency_msg.theta = 0.0; close_enemy_pos_pub_->publish(emergency_msg); - RCLCPP_WARN(this->get_logger(), "EMERGENCY CLOSE OBJECT DETECTED at x=%.2f y=%.2f (%.1f mm)", x_global, y_global, range_mm); + // RCLCPP_WARN(this->get_logger(), "EMERGENCY CLOSE OBJECT DETECTED at x=%.2f y=%.2f (%.1f mm)", x_global, y_global, range_mm); is_enemy_close_ = true; } break; } - - is_enemy_close_ = false; } // Convert to local robot frame diff --git a/src/modelec_strat/src/navigation_helper.cpp b/src/modelec_strat/src/navigation_helper.cpp index 544e782..1057e4a 100644 --- a/src/modelec_strat/src/navigation_helper.cpp +++ b/src/modelec_strat/src/navigation_helper.cpp @@ -580,6 +580,8 @@ namespace Modelec if (!last_was_close_enemy_) { + RCLCPP_INFO(node_->get_logger(), "Enemy is close, replanning..."); + last_was_close_enemy_ = true; pathfinding_->OnEnemyPosition(msg);