unilab.envs.common.rotation.np_quat_to_axis_angle

unilab.envs.common.rotation.np_quat_to_axis_angle(q)[source]

Convert unit quaternion batch (N, 4), w-first, to axis-angle vectors (N, 3).

Adapted from PyTorch3D. Uses atan2 + Taylor expansion for numerical stability near zero rotation.

Parameters:

q (ndarray)

Return type:

ndarray