More helpful error message
parent
5bb1564a74
commit
275c0ff4d3
|
@ -45,12 +45,12 @@ namespace gtsam {
|
|||
void Factor<KEY>::assertInvariants() const {
|
||||
#ifndef NDEBUG
|
||||
// Check that keys are all unique
|
||||
std::multiset < KeyType > nonunique(keys_.begin(), keys_.end());
|
||||
std::set < KeyType > unique(keys_.begin(), keys_.end());
|
||||
std::multiset<KeyType> nonunique(keys_.begin(), keys_.end());
|
||||
std::set<KeyType> unique(keys_.begin(), keys_.end());
|
||||
bool correct = (nonunique.size() == unique.size())
|
||||
&& std::equal(nonunique.begin(), nonunique.end(), unique.begin());
|
||||
if (!correct) throw std::logic_error(
|
||||
"Factor::assertInvariants: detected inconsistency");
|
||||
"Factor::assertInvariants: Factor contains duplicate keys");
|
||||
#endif
|
||||
}
|
||||
|
||||
|
|
Loading…
Reference in New Issue