diff --git a/gtsam/linear/NoiseModel.cpp b/gtsam/linear/NoiseModel.cpp index 933a40ab2..f98a92ff5 100644 --- a/gtsam/linear/NoiseModel.cpp +++ b/gtsam/linear/NoiseModel.cpp @@ -428,15 +428,13 @@ SharedDiagonal Constrained::QR(Matrix& Ab) const { Vector pseudo(m); // allocate storage for pseudo-inverse Vector invsigmas = reciprocal(sigmas_); - // Obtain the signs of each elements. - // We use negative signs to denote inequality constraints - // TODO: might be slow! - Vector signs(sigmas_.size()); - for (size_t s = 0; s