Print extra debug information for ILS in Debug mode
parent
ed721a152a
commit
2527f34e75
|
|
@ -487,6 +487,11 @@ boost::shared_ptr<GaussianConditional> HessianFactor::eliminateCholesky(const Or
|
||||||
// Erase the eliminated keys in this factor
|
// Erase the eliminated keys in this factor
|
||||||
keys_.erase(begin(), begin() + nFrontals);
|
keys_.erase(begin(), begin() + nFrontals);
|
||||||
} catch (const CholeskyFailed&) {
|
} catch (const CholeskyFailed&) {
|
||||||
|
#ifndef NDEBUG
|
||||||
|
cout << "Partial Cholesky on HessianFactor failed." << endl;
|
||||||
|
keys.print("Frontal keys ");
|
||||||
|
print("HessianFactor:");
|
||||||
|
#endif
|
||||||
throw IndeterminantLinearSystemException(keys.front());
|
throw IndeterminantLinearSystemException(keys.front());
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
|
||||||
Loading…
Reference in New Issue