mirror of
https://github.com/introlab/rtabmap.git
synced 2026-09-02 01:20:25 +08:00
Aborting path planned on "last node not found" error
This commit is contained in:
@@ -3099,7 +3099,8 @@ void Rtabmap::updateGoalIndex()
|
|||||||
if(_memory->getLastWorkingSignature() == 0 ||
|
if(_memory->getLastWorkingSignature() == 0 ||
|
||||||
!uContains(_optimizedPoses, _memory->getLastWorkingSignature()->id()))
|
!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;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|||||||
Reference in New Issue
Block a user