diff --git a/gtsam/inference/EliminationTree-inl.h b/gtsam/inference/EliminationTree-inl.h index 04374bfd3..6ae0b78c7 100644 --- a/gtsam/inference/EliminationTree-inl.h +++ b/gtsam/inference/EliminationTree-inl.h @@ -26,6 +26,10 @@ template typename EliminationTree::sharedFactor EliminationTree::eliminate_(Conditionals& conditionals) const { + static const bool debug = false; + + if(debug) cout << "ETree: eliminating " << this->key_ << endl; + set, boost::fast_pool_allocator > separator; // Create the list of factors to be eliminated, initially empty, and reserve space @@ -86,6 +90,8 @@ template typename EliminationTree::shared_ptr EliminationTree::Create(const FactorGraph& factorGraph, const VariableIndex& structure) { + static const bool debug = false; + tic("ET 1: Create"); tic("ET 1.1: ComputeParents"); @@ -128,6 +134,9 @@ EliminationTree::Create(const FactorGraph& factorGraph, c assert((*tree) != shared_ptr()); #endif + if(debug) + trees.back()->print("ETree: "); + return trees.back(); }