diff --git a/include/small_gicp/registration/optimizer.hpp b/include/small_gicp/registration/optimizer.hpp index aa682b0..cfbf52f 100644 --- a/include/small_gicp/registration/optimizer.hpp +++ b/include/small_gicp/registration/optimizer.hpp @@ -124,6 +124,7 @@ struct LevenbergMarquardtOptimizer { result.T_target_source = new_T; lambda /= lambda_factor; success = true; + e = new_e; break; } else {