Bug fix when relinearizing on first step in iSAM2
parent
8cd7662dab
commit
7226f910bb
|
|
@ -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);
|
||||
}
|
||||
|
||||
}
|
||||
|
|
|
|||
Loading…
Reference in New Issue