12345qiupeng
/
gtsam
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Removed problematic 'inline'

release/4.3a0
Richard Roberts 2012-03-23 04:05:51 +00:00
parent eabcf151e2
commit d577655f1b
1 changed files with 3 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

6
gtsam/linear/JacobianFactor.cpp
View File

@ -42,20 +42,20 @@ using namespace boost::lambda;
namespace gtsam { namespace gtsam {
/* ************************************************************************* */ /* ************************************************************************* */
inline void JacobianFactor::assertInvariants() const { void JacobianFactor::assertInvariants() const {
#ifndef NDEBUG #ifndef NDEBUG
GaussianFactor::assertInvariants(); // The base class checks for unique keys GaussianFactor::assertInvariants(); // The base class checks for unique keys
assert((size() == 0 && Ab_.rows() == 0 && Ab_.nBlocks() == 0) || size()+1 == Ab_.nBlocks()); assert((size() == 0 && Ab_.rows() == 0 && Ab_.nBlocks() == 0) || size()+1 == Ab_.nBlocks());
assert(firstNonzeroBlocks_.size() == Ab_.rows()); assert(firstNonzeroBlocks_.size() == Ab_.rows());
for(size_t i=0; i<firstNonzeroBlocks_.size(); ++i) for(size_t i=0; i<firstNonzeroBlocks_.size(); ++i)
assert(firstNonzeroBlocks_[i] < Ab_.nBlocks()); assert(firstNonzeroBlocks_[i] < Ab_.nBlocks());
#endif
// Check for non-finite values // Check for non-finite values
for(size_t i=0; i<Ab_.rows(); ++i) for(size_t i=0; i<Ab_.rows(); ++i)
for(size_t j=0; j<Ab_.cols(); ++j) for(size_t j=0; j<Ab_.cols(); ++j)
if(isnan(matrix_(i,j))) if(isnan(matrix_(i,j)))
throw invalid_argument("JacobianFactor contains NaN matrix entries."); throw invalid_argument("JacobianFactor contains NaN matrix entries.");
#endif
} }
/* ************************************************************************* */ /* ************************************************************************* */