check for 0 sum

2023-01-02 10:03:56 -05:00 · 2023-01-02 10:03:56 -05:00 · e3a63aa77c
parent cae98e1d3e
commit e3a63aa77c
1 changed files with 4 additions and 0 deletions
--- a/gtsam/hybrid/HybridGaussianFactorGraph.cpp
+++ b/gtsam/hybrid/HybridGaussianFactorGraph.cpp
@ -285,6 +285,10 @@ hybridElimination(const HybridGaussianFactorGraph &factors,
    double sum = 0.0;
    auto visitor = [&](double y) { sum += y; };
    fdt.visit(visitor);
+    // Check if sum is 0, and update accordingly.
+    if (sum == 0) {
+      sum = 1.0;
+    }
    // fdt = DecisionTree<Key, double>(fdt,
    //                                 [sum](const double &x) { return x / sum;
    //                                 });