Fixed debug and error message in JacobianFactor _countDims
parent
d912868ca6
commit
09309e2869
|
@ -134,8 +134,6 @@ namespace gtsam {
|
||||||
model_ = noiseModel::Unit::Create(maxrank);
|
model_ = noiseModel::Unit::Create(maxrank);
|
||||||
}
|
}
|
||||||
|
|
||||||
#undef GTSAM_EXTRA_CONSISTENCY_CHECKS
|
|
||||||
|
|
||||||
/* ************************************************************************* */
|
/* ************************************************************************* */
|
||||||
// Helper functions for combine constructor
|
// Helper functions for combine constructor
|
||||||
namespace {
|
namespace {
|
||||||
|
@ -188,8 +186,7 @@ namespace gtsam {
|
||||||
}
|
}
|
||||||
|
|
||||||
if(!foundVariable)
|
if(!foundVariable)
|
||||||
GaussianFactorGraph(factors).print("factors: ");
|
throw std::invalid_argument("Unable to determine dimensionality for all variables");
|
||||||
assert(foundVariable);
|
|
||||||
}
|
}
|
||||||
|
|
||||||
BOOST_FOREACH(const JacobianFactor::shared_ptr& factor, factors) {
|
BOOST_FOREACH(const JacobianFactor::shared_ptr& factor, factors) {
|
||||||
|
|
Loading…
Reference in New Issue