Aborting path planned on "last node not found" error

This commit is contained in:
Mathieu Labbe
2015-05-04 18:35:29 -04:00
parent 1febdfd183
commit 0b5d6c84b1

View File

@@ -3099,7 +3099,8 @@ void Rtabmap::updateGoalIndex()
if(_memory->getLastWorkingSignature() == 0 ||
!uContains(_optimizedPoses, _memory->getLastWorkingSignature()->id()))
{
UERROR("Last node is null in memory or not in optimized poses");
UERROR("Last node is null in memory or not in optimized poses. Aborting the plan...");
this->clearPath();
return;
}