Add example to visualize floating base velocity #2143
Merged
Add this suggestion to a batch that can be applied as a single commit.
This suggestion is invalid because no changes were made to the code.
Suggestions cannot be applied while the pull request is closed.
Suggestions cannot be applied while viewing a subset of changes.
Only one suggestion per line can be applied in a batch.
Add this suggestion to a batch that can be applied as a single commit.
Applying suggestions on deleted lines is not supported.
You must change the existing code in this line in order to create a valid suggestion.
Outdated suggestions cannot be applied.
This suggestion has been applied or marked resolved.
Suggestions cannot be applied from pending reviews.
Suggestions cannot be applied on multi-line comments.
Suggestions cannot be applied while the pull request is queued to merge.
Suggestion cannot be applied right now. Please check back later.
After several questions/discussions (e.g. #1657, #1357, #1137, #1122) about the conventions used for the velocity vector for different joints that can serve as a floating base, I started a small script to verify.
This script builds a simple robot that is just a box with dimensions x=0.8, y=0.4, z=0.2. The floating base can be set to either
JointModelFreeFlyer
,JointModelSphericalZYX
orJointModelSpherical
. It prints several properties of the mode, increments each velocity component by 1, calculates the resultinga
,v_next
,q_next
viapin.aba
and visualizes the integrated configuration q_next via MeshCat.This could be useful for people who want to try it out for themselves. Also, we could add more joints in the future to test them as well.