From 80340c8b5ae117bbb36e18485d3f078e56926d3b Mon Sep 17 00:00:00 2001 From: tomoya Date: Fri, 29 Nov 2019 22:12:31 +0900 Subject: [PATCH] should also check if action status publisher is ready. (#541) Signed-off-by: Tomoya.Fujita --- rcl_action/src/rcl_action/action_client.c | 7 +++++++ 1 file changed, 7 insertions(+) diff --git a/rcl_action/src/rcl_action/action_client.c b/rcl_action/src/rcl_action/action_client.c index d1e437e..03b7b85 100644 --- a/rcl_action/src/rcl_action/action_client.c +++ b/rcl_action/src/rcl_action/action_client.c @@ -284,6 +284,13 @@ rcl_action_server_is_available( } *is_available = *is_available && (number_of_publishers != 0); + ret = rcl_subscription_get_publisher_count( + &(client->impl->status_subscription), &number_of_publishers); + if (RCL_RET_OK != ret) { + return ret; // error is already set + } + *is_available = *is_available && (number_of_publishers != 0); + return RCL_RET_OK; }