12345qiupeng
/
gtsam
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

remove print function

release/4.3a0
Varun Agrawal 2022-10-11 13:27:15 -04:00
parent 80908126db
commit eacc888d20
1 changed files with 0 additions and 17 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

17
gtsam/hybrid/tests/testHybridNonlinearISAM.cpp
View File

@ -391,23 +391,6 @@ TEST(HybridNonlinearISAM, Incremental_approximate) {
5, bayesTree[X(5)]->conditional()->asMixture()->nrComponents()); 5, bayesTree[X(5)]->conditional()->asMixture()->nrComponents());
} }
void printConditionals(const HybridNonlinearISAM &inc, const KeyVector &keys) {
HybridGaussianISAM bayesTree = inc.bayesTree();
for (auto &&key : keys) {
std::cout << DefaultKeyFormatter(key) << std::endl;
auto conditional = bayesTree[key]->conditional();
conditional->printKeys();
if (conditional->isHybrid()) {
std::cout << conditional->asMixture()->nrComponents() << std::endl;
} else if (conditional->isDiscrete()) {
std::cout << conditional->asDiscreteConditional()->nrLeaves()
<< std::endl;
} else {
// std::cout << conditional->asGaussian()->nrComponents() << std::endl;
}
}
}
/* ************************************************************************/ /* ************************************************************************/
// A GTSAM-only test for running inference on a single-legged robot. // A GTSAM-only test for running inference on a single-legged robot.
// The leg links are represented by the chain X-Y-Z-W, where X is the base and // The leg links are represented by the chain X-Y-Z-W, where X is the base and