Skip to content

Commit

Permalink
Merge pull request #170 from ami-iit/flferretti-patch-2
Browse files Browse the repository at this point in the history
Fix prismatic joints transform in `math.joint_model.supported_joint_motion`
  • Loading branch information
flferretti committed Jun 5, 2024
2 parents 44b9aee + a260650 commit 4a7e2e8
Showing 1 changed file with 4 additions and 1 deletion.
5 changes: 4 additions & 1 deletion src/jaxsim/math/joint_model.py
Original file line number Diff line number Diff line change
Expand Up @@ -267,7 +267,10 @@ def compute_P() -> tuple[jtp.Matrix, jtp.Array]:
# This is a metadata required by only some joint types.
axis = jnp.array(joint_axis).astype(float).squeeze()

pre_H_suc = jaxlie.SE3.from_translation(translation=jnp.array(s * axis))
pre_H_suc = jaxlie.SE3.from_rotation_and_translation(
rotation=jaxlie.SO3.identity(),
translation=jnp.array(s * axis),
)

S = jnp.vstack(jnp.hstack([axis, jnp.zeros(3)]))

Expand Down

0 comments on commit 4a7e2e8

Please sign in to comment.