Skip to content
New issue

Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.

By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.

Already on GitHub? Sign in to your account

Pass more distance information out from FCL collision check #2572

Merged
merged 6 commits into from
Dec 6, 2023

Conversation

stephanie-eng
Copy link
Contributor

Description

Bring moveit/moveit#3531 to MoveIt 2

The CollisionResult struct doesn't capture some useful information from the FCL collision check. Particularly of interest to us is when calculating the distance to collision (available information today), we'd like to know the two link names that are closest to collision.

This PR adds the DistanceResult as part of the CollisionResult such that we can access this information, and more.

Copy link
Contributor

@sea-bass sea-bass left a comment

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

yay! Thanks for bringing this up to ROS 2

Copy link
Contributor

@sjahr sjahr left a comment

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

Thank you! My comments are not supposed to block this PR.

double distance = std::numeric_limits<double>::max();

/** \brief Distance data for each link */
DistanceResult distance_result;
Copy link
Contributor

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

What about making this an optional field
std::optional

Copy link

codecov bot commented Dec 6, 2023

Codecov Report

Attention: 2 lines in your changes are missing coverage. Please review.

Comparison is base (34a9d59) 50.87% compared to head (bbad8cd) 50.49%.

Files Patch % Lines
.../collision_detection_fcl/src/collision_env_fcl.cpp 50.00% 2 Missing ⚠️
Additional details and impacted files
@@            Coverage Diff             @@
##             main    #2572      +/-   ##
==========================================
- Coverage   50.87%   50.49%   -0.37%     
==========================================
  Files         388      387       -1     
  Lines       32323    32157     -166     
==========================================
- Hits        16441    16236     -205     
- Misses      15882    15921      +39     

☔ View full report in Codecov by Sentry.
📢 Have feedback on the report? Share it here.

@sjahr sjahr merged commit 6eca49e into moveit:main Dec 6, 2023
10 of 12 checks passed
@sjahr
Copy link
Contributor

sjahr commented Dec 6, 2023

CI error is not related to this PR

Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
None yet
Projects
None yet
Development

Successfully merging this pull request may close these issues.

None yet

3 participants