Only check for non-finite values when debugging

release/4.3a0
Richard Roberts 2011-02-04 02:38:55 +00:00
parent a208515055
commit a67d974254
1 changed files with 2 additions and 0 deletions

View File

@ -52,11 +52,13 @@ namespace gtsam {
/* ************************************************************************* */
void HessianFactor::assertInvariants() const {
#ifndef NDEBUG
// Check for non-finite values
for(size_t i=0; i<matrix_.size1(); ++i)
for(size_t j=0; j<matrix_.size2(); ++j)
if(!isfinite(matrix_(i,j)))
throw invalid_argument("HessianFactor contains non-finite matrix entries.");
#endif
}
/* ************************************************************************* */