jrl-umi3218 / Tasks

The Tasks library is designed to make real-time control for kinematics tree and list of kinematics tree.
BSD 2-Clause "Simplified" License
90 stars 29 forks source link

Account for allowed changes in X_b1_b2 in contact constraint #67

Closed gergondet closed 4 years ago

gergondet commented 4 years ago

When a contact between two active robots (or when the only active robot is the second robot in a contact) is added, the X_b1_b2 transformation is encoded into the transformation for b2 to the contact frame (X_b2_cf).

However, when we allow the frames to move relatively to each other (using a DoF matrix), we implicitly allow this X_b1_b2 transformation to change over time.

We should account for the change in the X_b1_b2 transformation that is allowed by this DoF. Otherwise, the DoF allows seemingly arbitrary motions of the two contact frames.