concepts.math.frame_utils_xyzw#

Functions

compose_transformation(pos1, quat1, pos2, quat2)

Compose two transformations.

compute_ee_quat_from_directions(u, v[, ...])

Compute the quaternion from two directions (the "down" direction for the end effector and the "forward" direction for the end effector).

compute_ee_rotation_mat_from_directions(u, v)

Compute the rotation matrix from two directions (the "down" direction for the end effector and the "forward" direction for the end effector).

frame_inv(pos_b, quat_b, a_to_b)

Inverse a frame with a transformation.

frame_mul(pos_a, quat_a, a_to_b)

Multiply a frame with a transformation.

get_transform_a_to_b(pos1, quat1, pos2, quat2)

Get the transformation from frame A to frame B.

inverse_transformation(pos, quat)

Inverse a transformation.

solve_ee_from_tool(target_tool_pos, ...)

Solve for the end-effector position and orientation given the tool position and orientation.

solve_tool_from_ee(ee_pos, ee_quat, ee_to_tool)