Skip to content

Commit

Permalink
Fix base acceleration transform to VelRepr.Mixed
Browse files Browse the repository at this point in the history
In Articulated Body Algorithm

Co-authored-by: Alessandro Croci <alessandro.croci@iit.it>
  • Loading branch information
flferretti and xela-95 committed Jun 14, 2024
1 parent 2e733fe commit 865e325
Showing 1 changed file with 1 addition and 1 deletion.
2 changes: 1 addition & 1 deletion src/jaxsim/api/model.py
Original file line number Diff line number Diff line change
Expand Up @@ -717,7 +717,7 @@ def to_active(
# In Mixed representation, we need to include a cross product in ℝ⁶.
# In Inertial and Body representations, the cross product is always zero.
C_X_W = jaxlie.SE3.from_matrix(W_H_C).inverse().adjoint()
return C_X_W @ (W_v̇_WB - Cross.vx(W_v_WC) @ W_v_WB)
return C_X_W @ W_v̇_WB - Cross.vx(W_v_WC) @ W_v_WB

def to_inertial():
# In this case C=W
Expand Down

0 comments on commit 865e325

Please sign in to comment.