Don't do neighbor refining if fast movement has been detected

This commit is contained in:
matlabbe
2022-02-20 18:09:39 -05:00
parent e297320dd5
commit e6a5fe9c26

View File

@@ -1437,7 +1437,8 @@ bool Rtabmap::process(
signature->getLinks().size() &&
signature->getLinks().begin()->second.type() == Link::kNeighbor &&
_memory->isIncremental() && // ignore pose matching in localization mode
rehearsedId == 0) // don't do it if rehearsal happened
rehearsedId == 0 && // don't do it if rehearsal happened
!tooFastMovement) // ignore if too fast movement has been detected
{
int oldId = signature->getLinks().begin()->first;
const Signature * oldS = _memory->getSignature(oldId);