diff --git a/gtsam/nonlinear/LevenbergMarquardtOptimizer.cpp b/gtsam/nonlinear/LevenbergMarquardtOptimizer.cpp index d774440e3..c959473a8 100644 --- a/gtsam/nonlinear/LevenbergMarquardtOptimizer.cpp +++ b/gtsam/nonlinear/LevenbergMarquardtOptimizer.cpp @@ -102,8 +102,8 @@ void LevenbergMarquardtOptimizer::iterate() { // for each of the variables, add a prior BOOST_FOREACH(const Values::KeyValuePair& key_value, state_.values) { size_t dim = key_value.value.dim(); - Matrix A = eye(dim); - Vector b = zero(dim); + Matrix A = Matrix::Identity(dim, dim); + Vector b = Vector::Zero(dim); SharedDiagonal model = noiseModel::Isotropic::Sigma(dim, sigma); dampedSystem += boost::make_shared(key_value.key, A, b, model); }