Skip to content
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

[fetch_moveit_config] set enforce_joint_model_state_space true #163

Open
wants to merge 1 commit into
base: melodic-devel
Choose a base branch
from

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