diff --git a/gtsam/nonlinear/ISAM2.cpp b/gtsam/nonlinear/ISAM2.cpp index 228b6e491..0c05d15c4 100644 --- a/gtsam/nonlinear/ISAM2.cpp +++ b/gtsam/nonlinear/ISAM2.cpp @@ -743,7 +743,8 @@ void gradientAtZero(const ISAM2& bayesTree, VectorValues& g) { g.setZero(); // Sum up contributions for each clique - gradientAtZeroTreeAdder(bayesTree.root(), g); + if(bayesTree.root()) + gradientAtZeroTreeAdder(bayesTree.root(), g); } }