diff --git a/gtsam/base/cholesky.h b/gtsam/base/cholesky.h index be108b081..155b36418 100644 --- a/gtsam/base/cholesky.h +++ b/gtsam/base/cholesky.h @@ -34,6 +34,12 @@ struct NegativeMatrixException : public std::exception { Matrix U; ///< The produced upper-triangular factor Matrix D; ///< The produced diagonal factor Detail(const Matrix& _A, const Matrix& _U, const Matrix& _D) /**< Detail constructor */ : A(_A), U(_A), D(_D) {} + void print(const std::string& str = "") const { + std::cout << str << "\n"; + gtsam::print(A, " A: "); + gtsam::print(U, " U: "); + gtsam::print(D, " D: "); + } }; const boost::shared_ptr detail; ///< Detail NegativeMatrixException() /**< Constructor with no detail */ {}