mirror of
https://github.com/introlab/rtabmap.git
synced 2026-10-04 17:17:47 +08:00
ignore ids< 0
This commit is contained in:
@@ -237,14 +237,14 @@ int main(int argc, char * argv[])
|
||||
|
||||
// Remove orphan nodes
|
||||
std::map<int, double> wm = memory.getWorkingMem();
|
||||
for(auto iter: wm)
|
||||
for(std::map<int, double>::iterator iter=wm.lower_bound(0); iter!=wm.end(); ++iter)
|
||||
{
|
||||
std::multimap<int, rtabmap::Link> links = memory.getLinks(iter.first);
|
||||
std::multimap<int, rtabmap::Link> links = memory.getLinks(iter->first);
|
||||
if(graph::filterLinks(links, Link::kSelfRefLink).empty())
|
||||
{
|
||||
// orphan
|
||||
memory.deleteLocation(iter.first, 0, keepLinked);
|
||||
printf("Removed orphan node %d\n", iter.first);
|
||||
memory.deleteLocation(iter->first, 0, keepLinked);
|
||||
printf("Removed orphan node %d\n", iter->first);
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
Reference in New Issue
Block a user