matrix_to_xyz_rpy

urdfpy.matrix_to_xyz_rpy(matrix)

Convert a 4x4 homogenous matrix to xyzrpy coordinates.

Parameters:matrix ((4,4) float) – The homogenous transform matrix. Returns:xyz_rpy – The xyz_rpy vector. Return type:(6,) float