From 6c1e29926ef3c520103b835ab2332cbe3e865b8a Mon Sep 17 00:00:00 2001 From: Kentaro Tanaka Date: Wed, 1 Sep 2021 20:18:02 +0900 Subject: [PATCH] fix expired goals capacity of action server Signed-off-by: Kentaro Tanaka --- rcl_action/src/rcl_action/action_server.c | 2 +- 1 file changed, 1 insertion(+), 1 deletion(-) diff --git a/rcl_action/src/rcl_action/action_server.c b/rcl_action/src/rcl_action/action_server.c index cbed688eb..a5b6dbde4 100644 --- a/rcl_action/src/rcl_action/action_server.c +++ b/rcl_action/src/rcl_action/action_server.c @@ -602,7 +602,7 @@ rcl_action_expire_goals( int64_t goal_time; size_t num_goal_handles = action_server->impl->num_goal_handles; for (size_t i = 0u; i < num_goal_handles; ++i) { - if (output_expired && i >= expired_goals_capacity) { + if (output_expired && num_goals_expired >= expired_goals_capacity) { // no more space to output expired goals, so stop expiring them break; }