diff --git a/gtsam/hybrid/HybridNonlinearFactor.cpp b/gtsam/hybrid/HybridNonlinearFactor.cpp index 376bc66f1..fa22051e5 100644 --- a/gtsam/hybrid/HybridNonlinearFactor.cpp +++ b/gtsam/hybrid/HybridNonlinearFactor.cpp @@ -99,7 +99,8 @@ AlgebraicDecisionTree HybridNonlinearFactor::errorTree( auto errorFunc = [continuousValues](const std::pair& f) { auto [factor, val] = f; - return factor->error(continuousValues) + val; + return factor ? factor->error(continuousValues) + val + : std::numeric_limits::infinity(); }; return {factors_, errorFunc}; }