From a5d7695fac60fd334c0b19d8b906ad7c89dd24d5 Mon Sep 17 00:00:00 2001 From: Richard Roberts Date: Wed, 22 Aug 2012 22:40:31 +0000 Subject: [PATCH] Removed commented-out code --- gtsam/linear/JacobianFactor.cpp | 53 --------------------------------- 1 file changed, 53 deletions(-) diff --git a/gtsam/linear/JacobianFactor.cpp b/gtsam/linear/JacobianFactor.cpp index 17d57f82b..d0023b766 100644 --- a/gtsam/linear/JacobianFactor.cpp +++ b/gtsam/linear/JacobianFactor.cpp @@ -501,59 +501,6 @@ namespace gtsam { // Start of next part model_ = noiseModel; return splitConditional(nrFrontals); - -// // Check for singular factor -// if(noiseModel->dim() < frontalDim) { -// throw domain_error((boost::format( -// "JacobianFactor is singular in variable %1%, discovered while attempting\n" -// "to eliminate this variable.") % front()).str()); -// } -// -// // Extract conditional -// tic(3, "cond Rd"); -// -// // Restrict the matrix to be in the first nrFrontals variables -// Ab_.rowEnd() = Ab_.rowStart() + frontalDim; -// const Eigen::VectorBlock sigmas = noiseModel->sigmas().segment(Ab_.rowStart(), Ab_.rowEnd()-Ab_.rowStart()); -// GaussianConditional::shared_ptr conditional(new GaussianConditional(begin(), end(), nrFrontals, Ab_, sigmas)); -// if(debug) conditional->print("Extracted conditional: "); -// Ab_.rowStart() += frontalDim; -// Ab_.firstBlock() += nrFrontals; -// toc(3, "cond Rd"); -// -// if(debug) conditional->print("Extracted conditionals: "); -// -// tic(4, "remaining factor"); -// // Take lower-right block of Ab to get the new factor -// Ab_.rowEnd() = noiseModel->dim(); -// keys_.erase(begin(), begin() + nrFrontals); -// // Set sigmas with the right model -// if (noiseModel->isConstrained()) -// model_ = noiseModel::Constrained::MixedSigmas(sub(noiseModel->sigmas(), frontalDim, noiseModel->dim())); -// else -// model_ = noiseModel::Diagonal::Sigmas(sub(noiseModel->sigmas(), frontalDim, noiseModel->dim())); -// if(debug) this->print("Eliminated factor: "); -// assert(Ab_.rows() <= Ab_.cols()-1); -// toc(4, "remaining factor"); -// -// // todo SL: deal with "dead" pivot columns!!! -// tic(5, "rowstarts"); -// size_t varpos = 0; -// firstNonzeroBlocks_.resize(this->rows()); -// for(size_t row=0; row