Print goal ID when sendind a goal

Signed-off-by: Jacob Perron <jacob@openrobotics.org>
ros2 · Apr 8, 2019 · 8ef62e0 · 8ef62e0
1 parent 0d13d00
commit 8ef62e0
Showing 1 changed file with 2 additions and 0 deletions.
diff --git a/ros2action/ros2action/verb/send_goal.py b/ros2action/ros2action/verb/send_goal.py
@@ -114,6 +114,8 @@ def send_goal(action_name, action_type, goal_values, feedback_callback):
         print('Goal was rejected.')
         return
 
+    print('Goal accepted with ID: {}\n'.format(bytes(goal_handle.goal_id.uuid).hex()))
+
     result_future = goal_handle.get_result_async()
     rclpy.spin_until_future_complete(node, result_future)