Adds IntensityOcTree: per-voxel intensity payload for OctoMap #435
Conversation
This file contains hidden or bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
Adds a new Octree implementation that stores intensity values in addition to occupancy probability. This new tree type allows for representing intensity information alongside spatial occupancy, enabling applications that require both geometric and radiometric data.
Ensures that intensity values are correctly propagated to child nodes when expanding an IntensityOcTreeNode. This change addresses a potential issue where newly created child nodes in an expanded node would not inherit the intensity of their parent, leading to inaccurate intensity representation in the octree.
Adds methods for intensity integration, pruning, and averaging in IntensityOcTree, enhancing node management and data consistency. Also introduces a small epsilon value to avoid division by zero.
Removes the unused `integrateNodeIntensity` method that takes an `IntensityOcTreeNode` and weight as input. This simplifies the API and removes potentially confusing or redundant methods.
Updates inner node occupancy recursively for intensity octrees. This change ensures that the intensity values of inner nodes are correctly updated based on the children's values, leading to a more accurate representation of the intensity distribution in the octree.
Adds a `computeUpdateKeys` method to `IntensityOcTree`. This method allows to compute the set of free and occupied cells corresponding to a pointcloud, using an alternative interface based on octomath vectors.
Improves the efficiency of the inner node occupancy update process by adding a condition to check for the presence of children before recursively updating occupancy. This avoids unnecessary processing when a node has no children, leading to performance gains, especially in sparse octrees.
|
Thanks! Any chance to add a few unit tests well? |
Sign up for free
to join this conversation on GitHub.
Already have an account?
Sign in to comment
2 participants
Add this suggestion to a batch that can be applied as a single commit.
This suggestion is invalid because no changes were made to the code.
Suggestions cannot be applied while the pull request is closed.
Suggestions cannot be applied while viewing a subset of changes.
Only one suggestion per line can be applied in a batch.
Add this suggestion to a batch that can be applied as a single commit.
Applying suggestions on deleted lines is not supported.
You must change the existing code in this line in order to create a valid suggestion.
Outdated suggestions cannot be applied.
This suggestion has been applied or marked resolved.
Suggestions cannot be applied from pending reviews.
Suggestions cannot be applied on multi-line comments.
Suggestions cannot be applied while the pull request is queued to merge.
Suggestion cannot be applied right now. Please check back later.
Adds a new IntensityOcTree / IntensityOcTreeNode that stores a single double intensity per leaf (same layout & API style as ColorOcTree).