Fix waiting events

ros2 · Jul 13, 2022 · e6ffa30 · e6ffa30
1 parent 9c61d18
commit e6ffa30
Showing 1 changed file with 9 additions and 0 deletions.
diff --git a/rmw_fastrtps_shared_cpp/src/rmw_wait.cpp b/rmw_fastrtps_shared_cpp/src/rmw_wait.cpp
@@ -191,6 +191,15 @@ __rmw_wait(
       bool active = false;
 
       if (ReturnCode_t::RETCODE_OK == ret_code) {
+        eprosima::fastdds::dds::Entity * entity = status_condition.get_entity();
+        eprosima::fastdds::dds::StatusMask changed_statuses = entity->get_status_changes();
+        if (changed_statuses.is_active(
+            rmw_fastrtps_shared_cpp::internal::rmw_event_to_dds_statusmask(
+              event->event_type)))
+        {
+          active = true;
+        }
+
         if (guard_condition->get_trigger_value()) {
           active = true;
           guard_condition->set_trigger_value(false);