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

Fix goal position tolerances from box primitive #35

Merged

Conversation

captain-yoshi
Copy link
Contributor

Converting a position constraint from a box primitive with dimension into absolute tolerances results in
doubling the tolerances wrt. the pose of the box. The sphere primitive doesn't suffer from this because the radius is taken and not the diameter. This may also resolve PR #25.

The goal position constraint used in the images below is a box primitive (see white box from left image). The start state is always the start of the segment path (leftmost).

The first two images below is the result of one run of STOMP using the described constraint. The end goal of the STOMP segment (rightmost) panda_link8 should be within the white box. I guess that STOMP chooses a random end goal within the constraint. We clearly see that the goal tolerances are not respected.

With this PR, the goal (blue line rightmost segment) is within the white box tolerances.

Converting a box primitive dimension in absolute tolerances results in
doubling the tolerances wrt. the pose of the BOX.
@jrgnicho jrgnicho merged commit 30bacd1 into ros-industrial:melodic-devel Oct 20, 2021
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
None yet
Development

Successfully merging this pull request may close these issues.

3 participants