Bearbeitung update_pose_send_goal.cpp