Skip to content
This repository was archived by the owner on Apr 10, 2025. It is now read-only.

Bugfix/fix lin plans using subframes#7

Merged
riv-mjohnson merged 8 commits intomasterfrom
bugfix/fix-lin-plans-using-subframes
Oct 31, 2023
Merged

Bugfix/fix lin plans using subframes#7
riv-mjohnson merged 8 commits intomasterfrom
bugfix/fix-lin-plans-using-subframes

Conversation

@riv-tnoble
Copy link
Copy Markdown

@riv-tnoble riv-tnoble commented Oct 31, 2023

Description

Fixes moveit#3517 by allowing pilz to use subframes in goal constraints.

Updates computePoseIK() to build a RobotState from the PlanningScene rather than the RobotModel, so that subframes are taken into account. Also adds some error handling logic around calls to this function as, currently, if the passed link_name does not exist, the start_pose is set to the identity pose, which leads to a less intuitive IK solver error later on.

Tests still need updating.

@riv-mjohnson riv-mjohnson merged commit 5341471 into master Oct 31, 2023
Sign up for free to subscribe to this conversation on GitHub. Already have an account? Sign in.

Labels

None yet

Projects

None yet

Development

Successfully merging this pull request may close these issues.

Pilz LIN motions with subframes are not linear in the motion the subframe takes

2 participants