From 3acc50e50f04ead5919f556af3a004221e755ab0 Mon Sep 17 00:00:00 2001 From: stevedan Date: Mon, 18 Nov 2024 19:39:52 +0100 Subject: [PATCH] readd removed line Signed-off-by: stevedan --- nav2_smac_planner/src/a_star.cpp | 1 + 1 file changed, 1 insertion(+) diff --git a/nav2_smac_planner/src/a_star.cpp b/nav2_smac_planner/src/a_star.cpp index cfff36adf9d..d895984b94c 100644 --- a/nav2_smac_planner/src/a_star.cpp +++ b/nav2_smac_planner/src/a_star.cpp @@ -291,6 +291,7 @@ bool AStarAlgorithm::areInputsValid() if (!_start || _goalsSet.empty()) { throw std::runtime_error("Failed to compute path, no valid start or goal given."); } + // Check if ending point is valid if (getToleranceHeuristic() < 0.001) { // if a node is not valid, prune it from the goals set