Fix NaN in Updated PathAlign (ros-navigation#3943)

jwallace42 · Nov 6, 2023 · 3d14d98 · 3d14d98
1 parent ea1902e
commit 3d14d98
Showing 1 changed file with 2 additions and 0 deletions.
diff --git a/nav2_mppi_controller/src/critics/path_align_critic.cpp b/nav2_mppi_controller/src/critics/path_align_critic.cpp
@@ -126,6 +126,8 @@ void PathAlignCritic::score(CriticData & data)
     }
     if (num_samples > 0) {
       cost[t] = summed_path_dist / num_samples;
+    } else {
+      cost[t] = 0.0f;
     }
   }