diff --git a/gtsam/linear/NoiseModel.cpp b/gtsam/linear/NoiseModel.cpp index 053820633..b1aad6f29 100644 --- a/gtsam/linear/NoiseModel.cpp +++ b/gtsam/linear/NoiseModel.cpp @@ -371,15 +371,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