panda_autograsp.functions.conversions.pose_msg_stamped_2_matrix

panda_autograsp.functions.conversions.pose_msg_stamped_2_matrix(pose_msg)[source]

Generate 4x4 homogeneous transformation matrix from a pose_stamped msg.

Parameters:pose_msg (geometry_msgs.msgs.PoseStamped) – Stamped pose message.
Returns:Homogeneous 4x4 transformation matrix.
Return type:numpy.array