diff --git a/crisp_py/utils/geometry.py b/crisp_py/utils/geometry.py index f6539d7..015cca7 100644 --- a/crisp_py/utils/geometry.py +++ b/crisp_py/utils/geometry.py @@ -59,8 +59,6 @@ def from_ros_msg(cls, msg: PoseStamped) -> "Pose": msg.pose.orientation.w, ] ) - quat_x_sign = np.sign(quat[0]) if quat[0] != 0 else 1.0 - quat *= quat_x_sign # Ensure a consistent quaternion sign orientation = Rotation.from_quat(quat) return cls(position, orientation) @@ -78,8 +76,6 @@ def from_transform_msg(cls, msg: TransformStamped) -> "Pose": msg.transform.rotation.w, ] ) - quat_x_sign = np.sign(quat[0]) if quat[0] != 0 else 1.0 - quat *= quat_x_sign # Ensure a consistent quaternion sign orientation = Rotation.from_quat(quat) return cls(position, orientation)