Fixed iSAM2 bug if back-substitution is triggered before the first elimination.
parent
afd2f6902f
commit
51949ba614
|
|
@ -109,6 +109,7 @@ namespace gtsam {
|
||||||
vector<bool> changed(keys.size(), false);
|
vector<bool> changed(keys.size(), false);
|
||||||
int count = 0;
|
int count = 0;
|
||||||
// starting from the root, call optimize on each conditional
|
// starting from the root, call optimize on each conditional
|
||||||
|
if(root)
|
||||||
internal::optimizeWildfire(root, threshold, changed, keys, delta, count);
|
internal::optimizeWildfire(root, threshold, changed, keys, delta, count);
|
||||||
return count;
|
return count;
|
||||||
}
|
}
|
||||||
|
|
|
||||||
Loading…
Reference in New Issue