fix expired goals capacity of action server (#931)

Signed-off-by: Kentaro Tanaka <spiralray@gmail.com>
ros2 · Sep 14, 2021 · eae50c9 · eae50c9
1 parent 7b899da
commit eae50c9
Showing 1 changed file with 1 addition and 1 deletion.
diff --git 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;
     }