Fix an infinite loop in GTSAM's nonlinear optimizer
parent
eafc3794b4
commit
041c4518bf
|
@ -101,7 +101,7 @@ void NonlinearOptimizer::defaultOptimize() {
|
||||||
cout << "newError: " << error() << endl;
|
cout << "newError: " << error() << endl;
|
||||||
} while (iterations() < params.maxIterations &&
|
} while (iterations() < params.maxIterations &&
|
||||||
!checkConvergence(params.relativeErrorTol, params.absoluteErrorTol, params.errorTol,
|
!checkConvergence(params.relativeErrorTol, params.absoluteErrorTol, params.errorTol,
|
||||||
currentError, error(), params.verbosity));
|
currentError, error(), params.verbosity) && std::isfinite(currentError));
|
||||||
|
|
||||||
// Printing if verbose
|
// Printing if verbose
|
||||||
if (params.verbosity >= NonlinearOptimizerParams::TERMINATION) {
|
if (params.verbosity >= NonlinearOptimizerParams::TERMINATION) {
|
||||||
|
|
Loading…
Reference in New Issue