diff --git a/behaviortree_ros2/include/behaviortree_ros2/bt_action_node.hpp b/behaviortree_ros2/include/behaviortree_ros2/bt_action_node.hpp index c6b0c97..e125afc 100644 --- a/behaviortree_ros2/include/behaviortree_ros2/bt_action_node.hpp +++ b/behaviortree_ros2/include/behaviortree_ros2/bt_action_node.hpp @@ -433,6 +433,12 @@ template inline template inline void RosActionNode::cancelGoal() { + if (!goal_handle_) + { + RCLCPP_WARN( node_->get_logger(), "cancelGoal called on an empty goal_handle"); + return; + } + auto future_result = action_client_->async_get_result(goal_handle_); auto future_cancel = action_client_->async_cancel_goal(goal_handle_);