diff --git a/gtsam/nonlinear/LevenbergMarquardtOptimizer.cpp b/gtsam/nonlinear/LevenbergMarquardtOptimizer.cpp index 9bc38822e..e5a503b10 100644 --- a/gtsam/nonlinear/LevenbergMarquardtOptimizer.cpp +++ b/gtsam/nonlinear/LevenbergMarquardtOptimizer.cpp @@ -123,7 +123,7 @@ void LevenbergMarquardtOptimizer::iterate() { Matrix A = Matrix::Identity(dim, dim); //Replace the identity matrix with diagonal of Hessian if (params_.diagonalDamping) { - A.diagonal() = hessianDiagonal.at(key_value.key)*state_.lambda; + A.diagonal() = hessianDiagonal.at(key_value.key); for (int aa=0; aa