Skip to content

Conversation

knorth55
Copy link
Contributor

fetch arm collides with base or torso when path constraints is given to MotionPlanRequest.
This is because Moveit computes in cartesian model state space when path constraints is given,
and it causes joint jump near singularity point.
With this joint jump, fetch's arm collides with its base or torso because fetch's arm is quite close to them.

Good case

Screencast.2022-10-13.23.06.20.mp4

Bad case

Screencast.2022-10-13.23.09.34.mp4

In this PR, I set enforce_joint_model_state_space true and enforce to use joint model state space.
This change may needs longer planning time but it is safe.

related:
moveit/moveit#541
moveit/moveit#562
moveit/moveit#2273

@erelson
Copy link
Collaborator

erelson commented Dec 29, 2022

Hi @knorth55 thanks for the PR! I only just saw it now, but will plan to look at your links to understand the (nice and small) change.

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