diff --git a/gtsam/discrete/TableFactor.cpp b/gtsam/discrete/TableFactor.cpp index cb60a9818..38b4ddd30 100644 --- a/gtsam/discrete/TableFactor.cpp +++ b/gtsam/discrete/TableFactor.cpp @@ -262,16 +262,21 @@ DecisionTreeFactor TableFactor::toDecisionTreeFactor() const { // k will be in reverse key order already uint64_t k; ss >> k; - std::cout << "ss: " << ss.str() << ", k=" << k << std::endl; + std::cout << "ss: " << ss.str() << ", k=" << k + << ", v=" << sparse_table_.coeff(i) << std::endl; pair_table.push_back(std::make_pair(k, sparse_table_.coeff(i))); } - // Sort based on key so we get values in reverse key order. + // Sort based on key assignment so we get values in reverse key order. std::sort( pair_table.begin(), pair_table.end(), [](const std::pair& a, const std::pair& b) { return a.first <= b.first; }); + std::cout << "Sorted pair_table:" << std::endl; + for (auto&& [k, v] : pair_table) { + std::cout << "k=" << k << ", v=" << v << std::endl; + } // Create the table vector std::vector table; std::for_each(pair_table.begin(), pair_table.end(),