From d82b3627e1aab5d057f1f967ad50410fbbaf067d Mon Sep 17 00:00:00 2001
From: CihatAltiparmak <cihataltiparmak1@gmail.com>
Date: Thu, 21 Sep 2023 11:36:02 +0300
Subject: [PATCH] Fixed problem to resend goal.

---
 .../include/behaviortree_ros2/bt_action_node.hpp          | 8 ++++++++
 1 file changed, 8 insertions(+)

diff --git a/behaviortree_ros2/include/behaviortree_ros2/bt_action_node.hpp b/behaviortree_ros2/include/behaviortree_ros2/bt_action_node.hpp
index 4a3ebb8..d9c0a9b 100644
--- a/behaviortree_ros2/include/behaviortree_ros2/bt_action_node.hpp
+++ b/behaviortree_ros2/include/behaviortree_ros2/bt_action_node.hpp
@@ -427,6 +427,7 @@ template<class T> inline
 template<class T> inline
   void RosActionNode<T>::cancelGoal()
 {
+  auto future_result = action_client_->async_get_result(goal_handle_);
   auto future_cancel = action_client_->async_cancel_goal(goal_handle_);
 
   if (callback_group_executor_.spin_until_future_complete(future_cancel, server_timeout_) !=
@@ -435,6 +436,13 @@ template<class T> inline
     RCLCPP_ERROR( node_->get_logger(), "Failed to cancel action server for [%s]",
                  prev_action_name_.c_str());
   }
+
+  if (callback_group_executor_.spin_until_future_complete(future_result) !=
+      rclcpp::FutureReturnCode::SUCCESS)
+  {
+    RCLCPP_ERROR( node_->get_logger(), "Failed to get result call failed :( for [%s]",
+                 prev_action_name_.c_str());
+  }
 }