From 3516f7a7e9073a7e003a8091bb24bc3133703e3e Mon Sep 17 00:00:00 2001 From: "mergify[bot]" <37929162+mergify[bot]@users.noreply.github.com> Date: Fri, 1 Mar 2024 09:27:14 -0800 Subject: [PATCH] bug fix (#4160) (#4162) Signed-off-by: Tianchu (cherry picked from commit 623434b09f25afac3872411b8fda786a6f6dce95) Co-authored-by: Chortine <107395103+Chortine@users.noreply.github.com> --- .../include/nav2_mppi_controller/tools/utils.hpp | 1 + 1 file changed, 1 insertion(+) diff --git a/nav2_mppi_controller/include/nav2_mppi_controller/tools/utils.hpp b/nav2_mppi_controller/include/nav2_mppi_controller/tools/utils.hpp index a31ce891058..9d8c49a9cfd 100644 --- a/nav2_mppi_controller/include/nav2_mppi_controller/tools/utils.hpp +++ b/nav2_mppi_controller/include/nav2_mppi_controller/tools/utils.hpp @@ -314,6 +314,7 @@ inline size_t findPathFurthestReachedPoint(const CriticData & data) for (size_t i = 0; i < dists.shape(0); i++) { min_id_by_path = 0; + min_distance_by_path = std::numeric_limits::max(); for (size_t j = 0; j < dists.shape(1); j++) { cur_dist = dists(i, j); if (cur_dist < min_distance_by_path) {