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

Fixed assert "((int)path.size() < = maxGraphDepth*2+1)" when Mem/ReduceGraph=On

Browse Source
This commit is contained in:
matlabbe
2016-11-02 13:06:38 -04:00
parent 8718bb4ff1
commit 043e288d70
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

@@ -2894,11 +2894,10 @@ std::map<int, std::map<int, Transform> > Rtabmap::getPaths(std::map<int, Transfo
}
}
UASSERT_MSG(path.size(), uFormat("nearestId=%d ids=%d", nearestId, (int)ids.size()).c_str());
if(maxGraphDepth > 0)
if(maxGraphDepth > 0 && !_memory->isGraphReduced() && (int)path.size() > maxGraphDepth*2+1)
{
UASSERT_MSG((int)path.size() <= maxGraphDepth*2+1,
uFormat("nearestId=%d path=%d ids=%d maxGraphDepth=%d",
nearestId, (int)path.size(), (int)ids.size(), maxGraphDepth).c_str());
UWARN("%s=Off but path(%d) > maxGraphDepth(%d)*2+1, nearestId=%d ids=%d. Is reduce graph activated before?",
Parameters::kMemReduceGraph().c_str(), (int)path.size(), maxGraphDepth, nearestId, (int)ids.size());
}
paths.insert(std::make_pair(nearestId, path));
}