diff --git a/gtsam/linear/HessianFactor.cpp b/gtsam/linear/HessianFactor.cpp index da7d7bd7b..d16373c78 100644 --- a/gtsam/linear/HessianFactor.cpp +++ b/gtsam/linear/HessianFactor.cpp @@ -487,6 +487,11 @@ boost::shared_ptr HessianFactor::eliminateCholesky(const Or // Erase the eliminated keys in this factor keys_.erase(begin(), begin() + nFrontals); } catch (const CholeskyFailed&) { +#ifndef NDEBUG + cout << "Partial Cholesky on HessianFactor failed." << endl; + keys.print("Frontal keys "); + print("HessianFactor:"); +#endif throw IndeterminantLinearSystemException(keys.front()); }