Truncate DOF values to 5 decimal places for CHOMP SDF hashing #317
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.
Gilwoo found that the tableclearing demo required many different hashed SDFs for HERB, even between the majority of plans in which the right arm is moving, with the left arm in its starting configuration. After some investigation, we found that the values for non-active DOFs were changing very slightly (especially noticeable around zero). This PR snaps the DOF values to the nearest 5th decimal digit (and handles values around zero). This doesn't avoid the general problem of hashing floating point values, but does mitigate it in many cases where non-active configurations are read from decimal-formatted model and configuration files.