i/rtabmap
1
0
Fork 0
mirror of https://github.com/introlab/rtabmap.git synced 2026-09-02 09:30:25 +08:00
Code Issues Packages Projects Releases Wiki Activity

rtabmap: fixed graph not re-optimized (if empty) after first localization on landmark

Browse Source
This commit is contained in:
matlabbe
2020-03-10 13:08:47 -04:00
parent bfc64c451a
commit 39724e239c
1 changed files with 3 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files

7
corelib/src/Rtabmap.cpp
View File

@@ -2571,9 +2571,9 @@ bool Rtabmap::process(
signaturesRetrieved.size()) // can be different map of the current one
&&
(_memory->isIncremental() ||
// In localization mode, the new node should be linked to another node or a landmark already in the graph
graph::filterLinks(signature->getLinks(), Link::kSelfRefLink).size() ||
(landmarkDetected!=0 && _optimizedPoses.find(landmarkDetected)!=_optimizedPoses.end())))
// In localization mode, the new node should be linked to another node or a landmark already in the working memory
graph::filterLinks(signature->getLinks(), Link::kSelfRefLink).size() ||
landmarkDetected!=0))
{
UASSERT(uContains(_optimizedPoses, signature->id()));
@@ -2834,7 +2834,6 @@ bool Rtabmap::process(
}
else
{
UINFO("Update map correction");
std::map<int, Transform> poses = _optimizedPoses;