fix expired goals capacity of action server (#931)

Signed-off-by: Kentaro Tanaka <spiralray@gmail.com> (cherry picked from commit eae50c9)
ros2 · Jan 12, 2022 · c827fb7 · c827fb7
1 parent e88a953
commit c827fb7
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;
     }