bullet-featherstone: Update fixed constraint behavior

[iche033]

🎉 New feature

Summary

There is an inconsistency between how fixed constraints work in dartsim and bullet-featherstone. Currently when a fixed constraint's parent link moves, the behavior in the two physics engine is:

• dartsim: child link is welded to parent and so it moves along with the parent -
• bullet-featherstone - corrects position errors and enforces constraint by moving both the parent and child links

Since there is desire to have both types of behavior so a new feature is added to toggle behavior of a fixed constraint:

• SetFixedJointWeldChildToParentFeature

By default, this property is true, i.e. child is always welded to parent link, so we do not break the fixed constraint behavior in dartsim. The bullet-featherstone fixed constraint implementation is updated to match this behavior. This is achieved by setting the pose of child at each iteration - not ideal but gives the expected behavior. Additionally, the bullet-featherstone plugin implements SetFixedJointWeldChildToParentFeature and lets users disable welding of links.

Update

• bullet-featherstone fixed joint implementation now calls setMaxAppliedImpulse to enforce fixed constraint.
• When the pose of the parent body of a fixed constraint is changed by FreeGroupSetWorldPose, the child pose is updated to enforce pose transform relative to the parent

Other changes to bullet-featherstone's fixed constraint implementation include:

• prevent collision between parent and child link if parent is static
• reverted some of the test/common_test/joint_features.cc changes done in #600 now that fixed constraints are more stable

Added new tests:

• test attaching fixed joint between non-static and static links
• test behavior changes with the new API provdided by theSetFixedJointWeldChildToParentFeature

known issues:

• overlapping parent and child links held together by fixed constraint still do not behave as expected in bullet version < 3.07:
  • if both parent and child links are non-static, they will be unstable. The setIgnoreCollisionCheck API does not seem to have an effect
  • If parent link is static, the 2 links will not collide but child link still produces non-zero velocities.

Test it

Here's an example showing the behavior of fixed constraint in bullet-featherstone plugin before and after the changes. The two models are connected using the Detachable Joint plugin. The red box is the parent while the blue box is the child.

Before:

After (matches dartsim fixed constraint behavior):

Checklist

• [x] Signed all commits for DCO
• [x] Added tests
• [ ] Added example and/or tutorial
• [ ] Updated documentation (as needed)
• [ ] Updated migration guide (as needed)
• [ ] Consider updating Python bindings (if the library has them)
• [ ] codecheck passed (See contributing)
• [ ] All tests passed (See test coverage)
• [ ] While waiting for a review on your PR, please help review another open pull request to support the maintainers

Note to maintainers: Remember to use Squash-Merge and edit the commit message to match the pull request summary while retaining Signed-off-by messages.

[codecov[bot]]

Codecov Report

Attention: Patch coverage is 92.23301% with 8 lines in your changes are missing coverage. Please review.

Project coverage is 79.04%. Comparing base (92e02c3) to head (c921141). Report is 16 commits behind head on gz-physics7.

:exclamation: Current head c921141 differs from pull request most recent head a112092

Please upload reports for the commit a112092 to get more accurate results.

Files	Patch %	Lines
bullet-featherstone/src/JointFeatures.cc	92.42%	5 Missing :warning:
bullet-featherstone/src/FreeGroupFeatures.cc	90.62%	3 Missing :warning:

Additional details and impacted files

```diff @@ Coverage Diff @@ ## gz-physics7 #632 +/- ## =============================================== + Coverage 78.32% 79.04% +0.71% =============================================== Files 140 140 Lines 8069 8240 +171 =============================================== + Hits 6320 6513 +193 + Misses 1749 1727 -22 ```

:umbrella: View full report in Codecov by Sentry.
:loudspeaker: Have feedback on the report? Share it here.