diff --git a/gtsam/hybrid/HybridGaussianConditional.cpp b/gtsam/hybrid/HybridGaussianConditional.cpp index 2a0b5a875..58724163e 100644 --- a/gtsam/hybrid/HybridGaussianConditional.cpp +++ b/gtsam/hybrid/HybridGaussianConditional.cpp @@ -22,7 +22,6 @@ #include #include #include -#include #include #include #include diff --git a/gtsam/hybrid/HybridGaussianConditional.h b/gtsam/hybrid/HybridGaussianConditional.h index 75138b0dc..4cc3d3196 100644 --- a/gtsam/hybrid/HybridGaussianConditional.h +++ b/gtsam/hybrid/HybridGaussianConditional.h @@ -26,7 +26,6 @@ #include #include #include -#include #include #include diff --git a/gtsam/hybrid/HybridGaussianProductFactor.cpp b/gtsam/hybrid/HybridGaussianProductFactor.cpp index 92888fbc8..f7b5994f0 100644 --- a/gtsam/hybrid/HybridGaussianProductFactor.cpp +++ b/gtsam/hybrid/HybridGaussianProductFactor.cpp @@ -70,19 +70,18 @@ HybridGaussianProductFactor& HybridGaussianProductFactor::operator+=( /* *******************************************************************************/ void HybridGaussianProductFactor::print(const std::string& s, const KeyFormatter& formatter) const { - // KeySet keys; - // auto printer = [&](const Y& y) { - // if (keys.empty()) keys = y.first.keys(); - // return "Graph of size " + std::to_string(y.first.size()) + - // ", scalar sum: " + std::to_string(y.second); - // }; - // Base::print(s, formatter, printer); - // if (!keys.empty()) { - // std::cout << s << " Keys:"; - // for (auto&& key : keys) std::cout << " " << formatter(key); - // std::cout << "." << std::endl; - // } - std::cout << "HybridGaussianProductFactor" << std::endl; + KeySet keys; + auto printer = [&](const Y& y) { + if (keys.empty()) keys = y.first.keys(); + return "Graph of size " + std::to_string(y.first.size()) + + ", scalar sum: " + std::to_string(y.second); + }; + Base::print(s, formatter, printer); + if (!keys.empty()) { + std::cout << s << " Keys:"; + for (auto&& key : keys) std::cout << " " << formatter(key); + std::cout << "." << std::endl; + } } /* *******************************************************************************/