Fixed errors and warnings on linux

release/4.3a0
Richard Roberts 2013-08-12 21:32:51 +00:00
parent 3e1852d239
commit 0b58b0166a
3 changed files with 2 additions and 5 deletions

View File

@ -201,7 +201,7 @@ void ISAM2::Impl::ExpmapMasked(Values& values, const VectorValues& delta,
assert(key_value->key == key_delta->first);
Key var = key_value->key;
assert(delta[var].size() == (int)key_value->value.dim());
assert(delta[var].unaryExpr(ptr_fun(isfinite<double>)).all());
assert(delta[var].allFinite());
if(mask.exists(var)) {
Value* retracted = key_value->value.retract_(delta[var]);
key_value->value = *retracted;

View File

@ -258,9 +258,6 @@ ISAM2::relinearizeAffectedFactors(const FastList<Key>& affectedKeys, const FastS
// find intermediate (linearized) factors from cache that are passed into the affected area
GaussianFactorGraph ISAM2::getCachedBoundaryFactors(Cliques& orphans) {
static const bool debug = false;
GaussianFactorGraph cachedBoundary;
BOOST_FOREACH(sharedClique orphan, orphans) {

View File

@ -649,7 +649,7 @@ namespace {
//Matrix actual2AugmentedHessian = linearFactors_.augmentedHessian();
Matrix actual3AugmentedHessian = isam.getFactorsUnsafe().linearize(
isam.getLinearizationPoint())->augmentedHessian();
assert(actualAugmentedHessian.unaryExpr(std::ptr_fun(&std::isfinite<double>)).all());
assert(actualAugmentedHessian.allFinite());
// Check full marginalization
//cout << "treeEqual" << endl;