gazebosim / gz-physics

Abstract physics interface designed to support simulation and rapid development of robot applications.
https://gazebosim.org
Apache License 2.0
62 stars 38 forks source link

bullet-featherstone: Fix model frame data pose #649

Open iche033 opened 1 month ago

iche033 commented 1 month ago

🦟 Bug fix

Related issue #648

Summary

Fix bullet-featherstone's model frame data pose. Also expanded test to cover nested model / link / collision

More info:

I added a couple of fields in ModelInfo (modelToRootLinkTf and nestedModelFromRootModelTf) to store transforms that are computed in SDFFeatures. These transforms are then used in KinematicFeatures for computing model and nested model frame data.

Checklist

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.