ROS Resources: Documentation | Support | Discussion Forum | Index | Service Status | ros @ Robotics Stack Exchange |
1 | initial version |
OctoMap has iterators for traversing the tree; I suggest using one of those, and ignoring those voxels that have the wrong z-value.