Skip to content
New issue

Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.

By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.

Already on GitHub? Sign in to your account

SE(3) transformations for SpatialForce and SpatialMomentum are wrong #169

Open
Yuxiang-Ma opened this issue Mar 6, 2025 · 0 comments
Open

Comments

@Yuxiang-Ma
Copy link

Among SpatialVector subclasses, some multiplication are defined as:

Certain subtypes can be multiplied

===================   ====================  ===================  =========================
            Multiplicands                   Product
------------------------------------------  ----------------------------------------------
left                  right                 type                 operation
===================   ====================  ===================  =========================
SE3, Twist3           SpatialVelocity       SpatialVelocity      adjoint product
SE3, Twist3           SpatialAcceleration   SpatialAcceleration  adjoint product
SE3, Twist3           SpatialMomentum       SpatialMomentum      adjoint transpose product
SE3, Twist3           SpatialForce          SpatialForce         adjoint transpose product
SpatialAcceleration   SpatialInertia        SpatialForce         matrix-vector product**
SpatialVelocity       SpatialInertia        SpatialMomentum      matrix-vector product**
===================   ====================  ===================  =========================

For SpatialMomemtum and SpatialForce, the operation should be adjoint transpose invese product because of the duality of motion space and force space. As described in Featherstone's Rigid Body Dynamics Algorithms:

Image

Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
None yet
Projects
None yet
Development

No branches or pull requests

1 participant