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

Construct IRIS-ZO Parameterization for Mimic Joints #22639

Open
cohnt opened this issue Feb 17, 2025 · 0 comments · May be fixed by #22733
Open

Construct IRIS-ZO Parameterization for Mimic Joints #22639

cohnt opened this issue Feb 17, 2025 · 0 comments · May be fixed by #22733
Assignees
Labels
component: graphs of convex sets Graphs of Convex Sets and related algorithms type: feature request

Comments

@cohnt
Copy link
Contributor

cohnt commented Feb 17, 2025

@sadraddini has requested this feature, and I'm planning to implement it myself soon. I'm creating the feature request because I wanted to solicit feedback before I do so. cc @RussTedrake

It seems like there are multiple ways to pull this off. One is to just have the user specify which joints are mimic joints. This seems ugly, but for simple setups (e.g. parallel jaw grippers), it would probably be the most convenient? We could also redo the parsing, but that seems very silly!

Another is to go into the MultibodyPlant and look for coupler constraints. But I'm worried this might turn into a footgun if the user has a discrete plant and isn't using SAP as the contact solver -- in that case, the mimic will be ignored, and the user could miss the warning. And in a more principled sense, it seems weird to make this (purely kinematic) method depend on what the user has selected as a solver for the contact dynamics in the plant.

However, inspecting the plant for the constraints also suggests the workflow of looking for weld constraints. This would be a much nicer workflow for IRIS regions in manipulation contexts, as the user could just weld free floating objects to make regions, instead of having to make an entirely separate set of directives.

Maybe the best option is to have two different setups?

  1. Introspect the MultibodyPlant for coupler and weld constraints. Warn the user that discrete and not SAP will not see mimic joints.
  2. Manually specify a list of mimic joints, along with their multipliers and offsets.
@cohnt cohnt added component: graphs of convex sets Graphs of Convex Sets and related algorithms type: feature request labels Feb 17, 2025
@cohnt cohnt self-assigned this Feb 17, 2025
@cohnt cohnt moved this to TODO (IRIS and Convex Sets) in Graphs of Convex Sets Feb 26, 2025
@cohnt cohnt moved this from TODO (IRIS and Convex Sets) to In Progress in Graphs of Convex Sets Mar 10, 2025
@cohnt cohnt linked a pull request Mar 10, 2025 that will close this issue
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
component: graphs of convex sets Graphs of Convex Sets and related algorithms type: feature request
Projects
Status: In Progress
Development

Successfully merging a pull request may close this issue.

1 participant