8000 [WIP] Account for the collision environment cache when moving a collision object by captain-yoshi · Pull Request #3694 · moveit/moveit · GitHub
[go: up one dir, main page]
More Web Proxy on the site http://driver.im/
Skip to content

[WIP] Account for the collision environment cache when moving a collision object #3694

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

Open
wants to merge 2 commits into
base: master
Choose a base branch
from

Conversation

captain-yoshi
Copy link
Contributor

PR #3601 did not account for the cache (or other initialization) when moving an object.

I have a situation where there is a collision between the lid and the pipette (left picture), but when checking closely there is none, e.g. the lid is open ! But at the start of the task, the lid is closed (right picture) and later on moved though the MOVE operation. So I reverted PR 3601 and there were no more errors, but the meshes were all recreated from scratch...

The only thing I can think off is that it used a cached version of the object from the initial state (it could also be my setup). I can reproduce this behaviour on my setup.

This PR now passes a MOVE operation to the createCollisionGeometry method where the local threaded cache is used. Instead of recreating the mesh from scratch it uses the collision geometry already computed from the ADD operation.

[ INFO] [1738621864.855714824]: Found a contact between 'thermocycler' (type 'Object') and 'pipette_base' (type 'Robot link'), which constitutes a collision. Contact information is not stored.
[ INFO] [1738621864.855768469]: Collision checking is considered complete (collision was found and 0 contacts are stored)
  0  - ←   0 →   -  0 / Move to joint
    0  - ←   0 →   -  0 / fixed state
    -  0 →   0 →   -  0 / Move Relative Above Bottom Container
    -  0 →   0 →   -  0 / dispense_liquid
    -  0 →   0 →   -  0 / mix_liquid
    -  0 →   0 →   -  0 / dispense_liquid
    -  0 →   0 →   -  0 / assert max distance
      -  0 →   0 →   -  0 / move to joint constraint
Failing stage(s):
fixed state (0/1): in collision
[ WARN] [1738621864.855978472]: Plan failed

My first attempt on adding a test could not reproduce the error I see in my setup. Will have to reattempt later.

…atch

Usefull when one wants to move the shape, thus saving time by not
recreating the complex mesh.
…MOVE action

PR moveit#3601 did not account for the cache (or other initialization) when moving an
object.

Branch to the `createCollisionGeometry` method where the cache is
applied, but use the already populated collision geometry instead of recreating from scratch.
@codecov-commenter
Copy link

⚠️ Please install the 'codecov app svg image' to ensure uploads and comments are reliably processed by Codecov.

Codecov Report

Attention: Patch coverage is 62.82051% with 29 lines in your changes missing coverage. Please review.

Project coverage is 47.91%. Comparing base (048b9e4) to head (c448f44).

Files with missing lines Patch % Lines
...e/collision_detection_fcl/src/collision_common.cpp 59.65% 23 Missing ⚠️
.../collision_detection_fcl/src/collision_env_fcl.cpp 71.43% 6 Missing ⚠️

❗ Your organization needs to install the Codecov GitHub app to enable full functionality.

Additional details and impacted files
@@            Coverage Diff             @@
##           master    #3694      +/-   ##
==========================================
- Coverage   48.01%   47.91%   -0.09%     
==========================================
  Files         605      605              
  Lines       61228    61332     +104     
  Branches     7027     7023       -4     
==========================================
- Hits        29390    29381       -9     
- Misses      31417    31530     +113     
  Partials      421      421              

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

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.

2 participants
0