Skip to content

Commit

Permalink
Rename log_SO3 to log_vee for clarity in SO(3) logarithm map computation
Browse files Browse the repository at this point in the history
  • Loading branch information
xela-95 committed Mar 5, 2025
1 parent dcc52fd commit 6aff9e1
Showing 1 changed file with 2 additions and 2 deletions.
4 changes: 2 additions & 2 deletions src/jaxsim/math/rotation.py
Original file line number Diff line number Diff line change
Expand Up @@ -84,15 +84,15 @@ def from_axis_angle(vector: jtp.Vector) -> jtp.Matrix:
return R.transpose()

@staticmethod
def log_SO3(R: jnp.ndarray) -> jtp.Vector:
def log_vee(R: jnp.ndarray) -> jtp.Vector:
"""
Compute the logarithm map of an SO(3) rotation matrix.
Args:
R: The SO(3) rotation matrix.
Returns:
The corresponding 3D Lie algebra element.
The corresponding SO(3) tangent vector.
"""
cos_theta = (jnp.trace(R) - 1) / 2
theta = jnp.arccos(jnp.clip(cos_theta, -1.0, 1.0))
Expand Down

0 comments on commit 6aff9e1

Please sign in to comment.