Skip to content

Compute Transformation Matrix Error

SUMMARY

compute_transformation_matrix_error computes a scalar SE(3) pose error, ‖log(T1⁻¹ · T2)‖₂, between a ground truth and an estimated 4x4 transform.

UNITS

T1 and T2 have translation in meters. The returned error mixes a rotational component in radians with a translational component in meters, so treat it as a unitless combined score rather than a physical distance.

The Skill

python
error = tfutils.compute_transformation_matrix_error(T1, T2)

Parameter Configuration

ParameterTypeDefaultDescription
T1np.ndarrayrequiredGround truth (4, 4) transformation matrix.
T2np.ndarrayrequiredEstimated (4, 4) transformation matrix.

Returns

TypeDescription
floatThe scalar SE(3) error, ‖log(T1⁻¹ · T2)‖₂.

Raises

ExceptionCondition
TypeErrorT1 is not a (4, 4) np.ndarray.
TypeErrorT2 is not a (4, 4) np.ndarray.