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

Adding EarlyStopped flag in GJK #371

Merged
merged 8 commits into from Jan 12, 2023
Merged

Conversation

lmontaut
Copy link
Contributor

When GJK early stops, the closest points p1 and p2 make no sense, so we can simply set them to nan.

Q: What should we do about distance? For now it is set to the distance between the origin and the separating hyperplane, but we could set it to nan like the closest points.

@jcarpent
Copy link
Member

Here the distance has a meaning as a lower distance bound.

jcarpent
jcarpent previously approved these changes Jan 11, 2023
Copy link
Member

@jcarpent jcarpent left a comment

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

Small comment: the idea of using NaN values is for propagation in the computational graph. For the end-user, no contact should be added in case a separating hyperplane is found.

jcarpent
jcarpent previously approved these changes Jan 11, 2023
@jcarpent
Copy link
Member

Importantly, this PR solves a bug occurring in Pinocchio in debug mode.

@jcarpent jcarpent merged commit d273fa6 into humanoid-path-planner:devel Jan 12, 2023
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.

None yet

2 participants