diff --git a/tests/testNonlinearOptimizer.cpp b/tests/testNonlinearOptimizer.cpp index 36da0fb0e..71d515c7a 100644 --- a/tests/testNonlinearOptimizer.cpp +++ b/tests/testNonlinearOptimizer.cpp @@ -254,6 +254,12 @@ TEST(NonlinearOptimizer, MoreOptimization) { // Try LM and Dogleg EXPECT(assert_equal(expected, LevenbergMarquardtOptimizer(fg, init).optimize())); EXPECT(assert_equal(expected, DoglegOptimizer(fg, init).optimize())); + + // Try LM with diagonal damping + LevenbergMarquardtParams params; + params.setDiagonalDamping(true); + LevenbergMarquardtOptimizer optimizer(fg, init, params); + EXPECT(assert_equal(expected, optimizer.optimize())); } /* ************************************************************************* */