xyz_rpy_to_matrix

urdfpy.xyz_rpy_to_matrix(xyz_rpy)

Convert xyz_rpy coordinates to a 4x4 homogenous matrix.

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