input: Write a python function to move a tool and assert that the tool_pose is correctly set.
  assert moveTool(PyKDL.Frame(), 2.0) == pm.toMsg(PyKDL.Frame())
  assert moveTool(PyKDL.Frame(PyKDL.Vector(1, 2, 3)), 3.0) == pm.toMsg(PyKDL.Frame(PyKDL.Vector(1, 2, 3)))
  assert moveTool(PyKDL.Frame(PyKDL.Rotation.RPY(0.1, 0.2, 0.3)), 1.0) == pm.toMsg(PyKDL.Frame(PyKDL.Rotation.RPY(0.1, 0.2, 0.3)))
output: import PyKDL
  import tf_conversions.posemath as pm
  
  def moveTool(tool_pose, timeout):
      return pm.toMsg(tool_pose)