fix(test_executors): Fix is_ready of TestWaitable

Signed-off-by: Janosch Machowinski <[email protected]>
ros2 · Nov 16, 2023 · eb39a3a · eb39a3a
1 parent 9c098e5
commit eb39a3a
Showing 1 changed file with 6 additions and 0 deletions.
diff --git a/rclcpp/test/rclcpp/executors/test_executors.cpp b/rclcpp/test/rclcpp/executors/test_executors.cpp
@@ -392,6 +392,12 @@ class TestWaitable : public rclcpp::Waitable
   bool
   is_ready(rcl_wait_set_t * wait_set) override
   {
+    for (size_t i = 0; i < wait_set->size_of_guard_conditions; ++i) {
+      if (&gc_.get_rcl_guard_condition() == wait_set->guard_conditions[i]) {
+        return true;
+      }
+    }
+    return false;
     (void)wait_set;
     return true;
   }