mirror of
https://github.com/introlab/rtabmap.git
synced 2026-09-02 01:20:25 +08:00
fixed octomap ground cells removed when updating graph
This commit is contained in:
@@ -114,7 +114,7 @@ void OctoMap::update(const std::map<int, Transform> & poses)
|
||||
octomap::OcTreeKey key;
|
||||
if(newOcTree->coordToKeyChecked(cvPt.x, cvPt.y, cvPt.z, key))
|
||||
{
|
||||
octomap::ColorOcTreeNode * n = newOcTree->updateNode(key, true);
|
||||
octomap::ColorOcTreeNode * n = newOcTree->updateNode(key, iter->second.isObstacle_);
|
||||
if(n)
|
||||
{
|
||||
++copied;
|
||||
|
||||
Reference in New Issue
Block a user