Add cost increase terminator back

cornellev · Dec 6, 2024 · 01ec871 · 01ec871
1 parent 0ed0636
commit 01ec871
Showing 1 changed file with 1 addition and 1 deletion.
diff --git a/lib/icp/icp_driver.cpp b/lib/icp/icp_driver.cpp
@@ -48,7 +48,7 @@ namespace icp {
 
         double delta_cost = current_state.cost - last_state.value().cost;
         if (delta_cost > 0) {
-            // return true;
+            return true;
         }
 
         if (absolute_cost_tolerance_ && std::abs(delta_cost) < absolute_cost_tolerance_.value()) {