Skip to content

Fix Pilz planner: consider link_name offset during IK computation#3523

Merged
rhaschke merged 2 commits intomoveit:masterfrom
ubi-agni:fix-pilz-planner
Nov 12, 2023
Merged

Fix Pilz planner: consider link_name offset during IK computation#3523
rhaschke merged 2 commits intomoveit:masterfrom
ubi-agni:fix-pilz-planner

Conversation

@rhaschke
Copy link
Copy Markdown
Contributor

Implement #3519 (comment):

Trajectory generation needs to use the actual link_name's (and its offset's) start and goal pose in order to realize a straigh-line motion. We must not back-project the offset to the associated robot link. Instead, we need to consider the offset during computation of the IK. I implemented this for the CartesianInterpolator in #3197.

Unfortunately, the unit tests don't cover those cases yet - they only consider the final goal pose, but don't check the path in between 😞

broken.mp4
fixed.mp4

@codecov
Copy link
Copy Markdown

codecov bot commented Nov 12, 2023

Codecov Report

All modified and coverable lines are covered by tests ✅

Comparison is base (ea9a0d3) 61.84% compared to head (1ace0e8) 61.88%.

❗ Current head 1ace0e8 differs from pull request most recent head c6e6cdc. Consider uploading reports for the commit c6e6cdc to get more accurate results

Additional details and impacted files
@@            Coverage Diff             @@
##           master    #3523      +/-   ##
==========================================
+ Coverage   61.84%   61.88%   +0.04%     
==========================================
  Files         385      385              
  Lines       34109    34106       -3     
==========================================
+ Hits        21093    21102       +9     
+ Misses      13016    13004      -12     
Files Coverage Δ
...z_industrial_motion_planner/trajectory_generator.h 100.00% <ø> (ø)
...trial_motion_planner/src/path_circle_generator.cpp 100.00% <100.00%> (ø)
...anner/src/trajectory_blender_transition_window.cpp 100.00% <100.00%> (ø)
...strial_motion_planner/src/trajectory_functions.cpp 100.00% <100.00%> (ø)
...l_motion_planner/src/trajectory_generator_circ.cpp 100.00% <100.00%> (+0.98%) ⬆️
...al_motion_planner/src/trajectory_generator_lin.cpp 100.00% <100.00%> (ø)
...al_motion_planner/src/trajectory_generator_ptp.cpp 98.98% <100.00%> (+0.04%) ⬆️

... and 5 files with indirect coverage changes

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

@rhaschke rhaschke force-pushed the fix-pilz-planner branch 2 times, most recently from 1ace0e8 to c6e6cdc Compare November 12, 2023 03:39
@rhaschke rhaschke merged commit 942abef into moveit:master Nov 12, 2023
@rhaschke rhaschke deleted the fix-pilz-planner branch November 12, 2023 11:35
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.

1 participant