diff --git a/gtsam/linear/NoiseModel.cpp b/gtsam/linear/NoiseModel.cpp index b8b17f6c6..a8b177b43 100644 --- a/gtsam/linear/NoiseModel.cpp +++ b/gtsam/linear/NoiseModel.cpp @@ -141,7 +141,7 @@ bool Gaussian::equals(const Base& expected, double tol) const { /* ************************************************************************* */ Vector Gaussian::sigmas() const { // TODO(frank): can this be done faster? - return (thisR().transpose() * thisR()).inverse().diagonal().array().sqrt(); + return Vector((thisR().transpose() * thisR()).inverse().diagonal()).cwiseSqrt(); } /* ************************************************************************* */