From 7c13032f067d9db2c5e681a87c14b8a9e8b6b3b2 Mon Sep 17 00:00:00 2001
From: Sebastian Castro <sebas.a.castro@gmail.com>
Date: Wed, 13 Dec 2023 17:31:57 -0500
Subject: [PATCH] Send a cancellation message when action is canceled

---
 .../src/rosbridge_library/capabilities/advertise_action.py  | 6 ++++++
 1 file changed, 6 insertions(+)

diff --git a/rosbridge_library/src/rosbridge_library/capabilities/advertise_action.py b/rosbridge_library/src/rosbridge_library/capabilities/advertise_action.py
index e94ae83fb..4a6c0fd7f 100644
--- a/rosbridge_library/src/rosbridge_library/capabilities/advertise_action.py
+++ b/rosbridge_library/src/rosbridge_library/capabilities/advertise_action.py
@@ -112,6 +112,12 @@ def cancel_callback(self, cancel_request: ServerGoalHandle) -> CancelResponse:
             if cancel_request.goal_id == goal_handle.goal_id:
                 self.protocol.log("warning", f"Canceling action {goal_id}")
                 self.goal_futures[goal_id].cancel()
+                cancel_message = {
+                    "op": "cancel_action_goal",
+                    "id": goal_id,
+                    "action": self.action_name,
+                }
+                self.protocol.send(cancel_message)
         return CancelResponse.ACCEPT
 
     def handle_feedback(self, goal_id: str, feedback: Any) -> None: