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();
|
g.setZero();
|
||||||
|
|
||||||
// Sum up contributions for each clique
|
// Sum up contributions for each clique
|
||||||
gradientAtZeroTreeAdder(bayesTree.root(), g);
|
if(bayesTree.root())
|
||||||
|
gradientAtZeroTreeAdder(bayesTree.root(), g);
|
||||||
}
|
}
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
|
||||||
Loading…
Reference in New Issue