(in branch) disabled key ordering checks for ISAM2
parent
32a0146722
commit
1936f34f22
|
|
@ -47,11 +47,11 @@ namespace gtsam {
|
|||
void BayesTree<CONDITIONAL>::Clique::assertInvariants() const {
|
||||
#ifndef NDEBUG
|
||||
// We rely on the keys being sorted
|
||||
FastVector<Index> sortedUniqueKeys(conditional_->begin(), conditional_->end());
|
||||
std::sort(sortedUniqueKeys.begin(), sortedUniqueKeys.end());
|
||||
std::unique(sortedUniqueKeys.begin(), sortedUniqueKeys.end());
|
||||
assert(sortedUniqueKeys.size() == conditional_->size() &&
|
||||
std::equal(sortedUniqueKeys.begin(), sortedUniqueKeys.end(), conditional_->begin()));
|
||||
// FastVector<Index> sortedUniqueKeys(conditional_->begin(), conditional_->end());
|
||||
// std::sort(sortedUniqueKeys.begin(), sortedUniqueKeys.end());
|
||||
// std::unique(sortedUniqueKeys.begin(), sortedUniqueKeys.end());
|
||||
// assert(sortedUniqueKeys.size() == conditional_->size() &&
|
||||
// std::equal(sortedUniqueKeys.begin(), sortedUniqueKeys.end(), conditional_->begin()));
|
||||
#endif
|
||||
}
|
||||
|
||||
|
|
|
|||
|
|
@ -36,8 +36,8 @@ namespace gtsam {
|
|||
FastSet<Index> uniquesorted(beginFrontals(), endFrontals());
|
||||
assert(uniquesorted.size() == nrFrontals() && std::equal(uniquesorted.begin(), uniquesorted.end(), beginFrontals()));
|
||||
// Check that separator keys are less than parent keys
|
||||
BOOST_FOREACH(Index j, frontals()) {
|
||||
assert(find_if(beginParents(), endParents(), _1 < j) == endParents()); }
|
||||
//BOOST_FOREACH(Index j, frontals()) {
|
||||
// assert(find_if(beginParents(), endParents(), _1 < j) == endParents()); }
|
||||
#endif
|
||||
}
|
||||
|
||||
|
|
|
|||
Loading…
Reference in New Issue