gazebosim / gz-physics

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

bullet-featherstone - add applied constraint force torque to joint transmitted wrench #668

Closed iche033 closed 1 month ago

iche033 commented 4 months ago

🦟 Bug fix

Summary

Updated JointTransmittedWrench function to account for forces and torques applied by constraints, e.g. when velocity commands are sent, bullet uses a motor constraint to move the joint. The force torque feedback in this case is now consistent with what dartsim produces.

Test was originally written by @scpeters and Nils Berg so credit goes to them.

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.