mirror of
https://github.com/introlab/rtabmap.git
synced 2026-09-02 09:30:25 +08:00
OctoMap: fixed empty cells not all added to global occupancy grid
This commit is contained in:
@@ -817,7 +817,7 @@ bool OctoMap::update(const std::map<int, Transform> & poses)
|
||||
|
||||
updateMinMax(point);
|
||||
|
||||
RtabmapColorOcTreeNode * n = octree_->updateNode(key, false);
|
||||
RtabmapColorOcTreeNode * n = octree_->updateNode(key, false, true);
|
||||
if(n && n->getOccupancyType() == RtabmapColorOcTreeNode::kTypeUnknown)
|
||||
{
|
||||
n->setOccupancyType(RtabmapColorOcTreeNode::kTypeEmpty);
|
||||
@@ -829,7 +829,7 @@ bool OctoMap::update(const std::map<int, Transform> & poses)
|
||||
}
|
||||
}
|
||||
}
|
||||
//octree_->updateInnerOccupancy();
|
||||
octree_->updateInnerOccupancy();
|
||||
}
|
||||
|
||||
// compress map
|
||||
|
||||
Reference in New Issue
Block a user