concepts.dm.crowhat.manipulation_utils.pose_utils#

Functions

angle_distance(quat1, quat2)

Compute the difference between two quaternions: ||quat2 - quat1||.

canonicalize_pose(pos[, quat])

pose_difference(pose1, pose2)

Compute the difference between two poses: pose2 - pose1.

pose_distance(pose1, pose2)

Compute the difference between two poses: ||pose2 - pose1||.