Fix Pilz planner: consider link_name offset during IK computation#3523
Merged
rhaschke merged 2 commits intomoveit:masterfrom Nov 12, 2023
Merged
Fix Pilz planner: consider link_name offset during IK computation#3523rhaschke merged 2 commits intomoveit:masterfrom
rhaschke merged 2 commits intomoveit:masterfrom
Conversation
Partially reverts changes of moveit#2890
e152f21 to
ebd31ed
Compare
10 tasks
Codecov ReportAll modified and coverable lines are covered by tests ✅
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
☔ View full report in Codecov by Sentry. |
1ace0e8 to
c6e6cdc
Compare
6 tasks
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
Sign up for free
to join this conversation on GitHub.
Already have an account?
Sign in to comment
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.
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