Add two new attributes to weld constraints:

- `anchor` determines the point of wrench application, in the frame of body2.
- `tfratio` scales applied torques relative to applied forces.
- Add visualisation of both anchor points to both weld and connect constraints.
- Add a test model showing how the new weld parameters behave.

PiperOrigin-RevId: 470021901
Change-Id: I3faba0e5dcab2e29ee81096f5ff71ff66d99758c
This commit is contained in:
Alessio Quaglino
2022-08-25 10:21:26 -07:00
committed by Copybara-Service
parent e2c3f04097
commit d26501c0f3
20 changed files with 491 additions and 248 deletions
+3 -1
View File
@@ -456,7 +456,9 @@ void mjXWriter::OneEquality(XMLElement* elem, mjCEquality* peq, mjCDef* def) {
case mjEQ_WELD:
WriteAttrTxt(elem, "body1", peq->name1);
WriteAttrTxt(elem, "body2", peq->name2);
WriteAttr(elem, "relpose", 7, peq->data);
WriteAttr(elem, "anchor", 3, peq->data);
WriteAttr(elem, "torquescale", 1, peq->data+10);
WriteAttr(elem, "relpose", 7, peq->data+3);
break;
case mjEQ_JOINT: