fix(test_executors): Fix is_ready of TestWaitable

Signed-off-by: Janosch Machowinski <[email protected]>

Author: Janosch Machowinski

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;
   }