diff --git a/gtsam/linear/NoiseModel.cpp b/gtsam/linear/NoiseModel.cpp index b72843b83..473d1b839 100644 --- a/gtsam/linear/NoiseModel.cpp +++ b/gtsam/linear/NoiseModel.cpp @@ -131,7 +131,7 @@ SharedDiagonal Gaussian::QR(Matrix& Ab) const { // TODO: necessary to isolate last column? // householder(Ab, maxRank); - return SharedDiagonal(); + return Unit::Create(maxRank); } void Gaussian::WhitenSystem(vector& A, Vector& b) const {