Skip to content

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

Description

@Yuxiang-Ma

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

Metadata

Metadata

Assignees

No one assigned

    Labels

    No labels
    No labels

    Type

    No type

    Projects

    No projects

    Milestone

    No milestone

    Relationships

    None yet

    Development

    No branches or pull requests

    Issue actions