def to_Transform(klampt_se3):
"""From Klampt se3 element to ROS Transform """
ros_pose = Transform()
ros_pose.orientation = to_Quaternion(klampt_se3[0])
ros_pose.translation.x, ros_pose.translation.y, ros_pose.translation.z = klampt_se3[
1]
return ros_pose
