StatusCondition implementation [11824]

include/fastdds/dds/core/Entity.hpp

@@ -46,6 +46,7 @@ class Entity
             const StatusMask& mask = StatusMask::all())
         : status_mask_(mask)
         , status_changes_(StatusMask::none())
+        , status_condition_(this)
         , enable_(false)
     {
     }
@@ -124,10 +125,9 @@ class Entity
      * @brief Allows access to the StatusCondition associated with the Entity
      * @return Reference to StatusCondition object
      */
-    RTPS_DllAPI StatusCondition& get_statuscondition() const
+    RTPS_DllAPI StatusCondition& get_statuscondition()
     {
-        logWarning(CONDITION, "get_statuscondition method not implemented");
-        return const_cast<StatusCondition&>(status_condition_);
+        return status_condition_;
     }
 
 protected:

include/fastdds/dds/core/condition/StatusCondition.hpp

@@ -47,7 +47,28 @@ class StatusCondition : public Condition
 {
 public:
 
-    // StatusCondition not implemented.
+    StatusCondition(
+            Entity* parent);
+
+    ~StatusCondition() final;
+
+    // Non-copyable
+    StatusCondition(
+            const StatusCondition&) = delete;
+    StatusCondition& operator =(
+            const StatusCondition&) = delete;
+
+    // Non-movable
+    StatusCondition(
+            StatusCondition&&) = delete;
+    StatusCondition& operator =(
+            StatusCondition&&) = delete;
+
+    /**
+     * @brief Retrieves the trigger_value of the Condition
+     * @return true if trigger_value is set to 'true', 'false' otherwise
+     */
+    RTPS_DllAPI bool get_trigger_value() const override;
 
     /**
      * @brief Defines the list of communication statuses that are taken into account to determine the trigger_value
@@ -71,13 +92,16 @@ class StatusCondition : public Condition
 
     detail::StatusConditionImpl* get_impl()
     {
-        return nullptr;
+        return impl_.get();
     }
 
 protected:
 
-    //! StatusMask with relevant statuses set to 1
-    StatusMask status_mask;
+    //! DDS Entity for which this condition is monitoring the status
+    Entity* entity_ = nullptr;
+
+    //! Class implementation
+    std::unique_ptr<detail::StatusConditionImpl> impl_;
 
 };
 

src/cpp/CMakeLists.txt

@@ -162,6 +162,7 @@ set(${PROJECT_NAME}_source_files
     fastdds/core/condition/ConditionNotifier.cpp
     fastdds/core/condition/GuardCondition.cpp
     fastdds/core/condition/StatusCondition.cpp
+    fastdds/core/condition/StatusConditionImpl.cpp
     fastdds/core/condition/WaitSet.cpp
     fastdds/core/condition/WaitSetImpl.cpp
     fastdds/core/policy/ParameterList.cpp

src/cpp/fastdds/core/condition/StatusCondition.cpp

@@ -20,29 +20,45 @@
 #include <fastdds/dds/core/condition/StatusCondition.hpp>
 #include <fastrtps/types/TypesBase.h>
 
+#include <fastdds/core/condition/StatusConditionImpl.hpp>
+
 namespace eprosima {
 namespace fastdds {
 namespace dds {
 
 using eprosima::fastrtps::types::ReturnCode_t;
 
+StatusCondition::StatusCondition(
+        Entity* parent)
+    : Condition()
+    , entity_(parent)
+    , impl_(new detail::StatusConditionImpl(notifier_.get()))
+{
+}
+
+StatusCondition::~StatusCondition()
+{
+}
+
+bool StatusCondition::get_trigger_value() const
+{
+    return impl_->get_trigger_value();
+}
+
 ReturnCode_t StatusCondition::set_enabled_statuses(
         const StatusMask& mask)
 {
-    static_cast<void>(mask);
-    return ReturnCode_t::RETCODE_UNSUPPORTED;
+    return impl_->set_enabled_statuses(mask);
 }
 
 const StatusMask& StatusCondition::get_enabled_statuses() const
 {
-    logWarning(CONDITION, "get_enabled_statuses public member function not implemented");
-    return status_mask;
+    return impl_->get_enabled_statuses();
 }
 
 Entity* StatusCondition::get_entity() const
 {
-    logWarning(CONDITION, "get_entity public member function not implemented");
-    return nullptr;
+    return entity_;
 }
 
 }  // namespace dds

src/cpp/fastdds/core/condition/StatusConditionImpl.cpp

@@ -18,15 +18,21 @@
 
 #include "StatusConditionImpl.hpp"
 
+#include <mutex>
+
+#include <fastdds/core/condition/ConditionNotifier.hpp>
+
 namespace eprosima {
 namespace fastdds {
 namespace dds {
 namespace detail {
 
 StatusConditionImpl::StatusConditionImpl(
         ConditionNotifier* notifier)
+    : mask_(StatusMask::all())
+    , status_(StatusMask::none())
+    , notifier_(notifier)
 {
-    static_cast<void>(notifier);
 }
 
 StatusConditionImpl::~StatusConditionImpl()
@@ -35,28 +41,60 @@ StatusConditionImpl::~StatusConditionImpl()
 
 bool StatusConditionImpl::get_trigger_value() const
 {
-    return false;
+    std::lock_guard<std::mutex> guard(mutex_);
+    return (mask_ & status_).any();
 }
 
 ReturnCode_t StatusConditionImpl::set_enabled_statuses(
         const StatusMask& mask)
 {
-    static_cast<void>(mask);
-    return ReturnCode_t::RETCODE_UNSUPPORTED;
+    bool notify = false;
+    {
+        std::lock_guard<std::mutex> guard(mutex_);
+        bool old_trigger = (mask_ & status_).any();
+        mask_ = mask;
+        bool new_trigger = (mask_ & status_).any();
+        notify = !old_trigger && new_trigger;
+    }
+
+    if (notify)
+    {
+        notifier_->notify();
+    }
+    return ReturnCode_t::RETCODE_OK;
 }
 
 const StatusMask& StatusConditionImpl::get_enabled_statuses() const
 {
-    static const StatusMask none = StatusMask::none();
-    return none;
+    std::lock_guard<std::mutex> guard(mutex_);
+    return mask_;
 }
 
 void StatusConditionImpl::set_status(
         const StatusMask& status,
         bool trigger_value)
 {
-    static_cast<void>(status);
-    static_cast<void>(trigger_value);
+    if (trigger_value)
+    {
+        bool notify = false;
+        {
+            std::lock_guard<std::mutex> guard(mutex_);
+            bool old_trigger = (mask_ & status_).any();
+            status_ |= status;
+            bool new_trigger = (mask_ & status_).any();
+            notify = !old_trigger && new_trigger;
+        }
+
+        if (notify)
+        {
+            notifier_->notify();
+        }
+    }
+    else
+    {
+        std::lock_guard<std::mutex> guard(mutex_);
+        status_ &= ~status;
+    }
 }
 
 }  // namespace detail

src/cpp/fastdds/core/condition/StatusConditionImpl.hpp

@@ -19,6 +19,8 @@
 #ifndef _FASTDDS_CORE_CONDITION_STATUSCONDITIONIMPL_HPP_
 #define _FASTDDS_CORE_CONDITION_STATUSCONDITIONIMPL_HPP_
 
+#include <mutex>
+
 #include <fastdds/dds/core/status/StatusMask.hpp>
 #include <fastrtps/types/TypesBase.h>
 
@@ -82,6 +84,13 @@ struct StatusConditionImpl
     void set_status(
             const StatusMask& status,
             bool trigger_value);
+
+private:
+
+    mutable std::mutex mutex_;
+    StatusMask mask_{};
+    StatusMask status_{};
+    ConditionNotifier* notifier_;
 };
 
 }  // namespace detail

test/unittest/dds/core/entity/CMakeLists.txt

@@ -26,6 +26,7 @@ if(NOT ((MSVC OR MSVC_IDE) AND EPROSIMA_INSTALLER))
             ${PROJECT_SOURCE_DIR}/src/cpp/fastdds/core/condition/Condition.cpp
             ${PROJECT_SOURCE_DIR}/src/cpp/fastdds/core/condition/ConditionNotifier.cpp
             ${PROJECT_SOURCE_DIR}/src/cpp/fastdds/core/condition/StatusCondition.cpp
+            ${PROJECT_SOURCE_DIR}/src/cpp/fastdds/core/condition/StatusConditionImpl.cpp
             ${PROJECT_SOURCE_DIR}/src/cpp/fastdds/core/condition/WaitSetImpl.cpp
             ${PROJECT_SOURCE_DIR}/src/cpp/fastdds/log/Log.cpp
             ${PROJECT_SOURCE_DIR}/src/cpp/fastdds/log/OStreamConsumer.cpp

test/unittest/dds/core/entity/EntityTests.cpp

@@ -151,15 +151,12 @@ TEST_F(EntityTests, entity_equal_operator)
     ASSERT_FALSE(entity1 == entity4);
 }
 
-/* Test unsupported methods behaviour*/
-TEST_F(EntityTests, unsupported_entity_methods)
+TEST_F(EntityTests, get_statuscondition)
 {
     Entity entity;
 
-    // It cannot compare because StatusCondition does not have comparaison methods
-    entity.get_statuscondition();
-
-    HELPER_WaitForEntries(1);
+    StatusCondition& cond = entity.get_statuscondition();
+    EXPECT_EQ(&entity, cond.get_entity());
 }
 
 int main(

test/unittest/dds/status/CMakeLists.txt

@@ -24,6 +24,7 @@ if(NOT ((MSVC OR MSVC_IDE) AND EPROSIMA_INSTALLER))
             ${PROJECT_SOURCE_DIR}/src/cpp/fastdds/core/condition/Condition.cpp
             ${PROJECT_SOURCE_DIR}/src/cpp/fastdds/core/condition/ConditionNotifier.cpp
             ${PROJECT_SOURCE_DIR}/src/cpp/fastdds/core/condition/StatusCondition.cpp
+            ${PROJECT_SOURCE_DIR}/src/cpp/fastdds/core/condition/StatusConditionImpl.cpp
             ${PROJECT_SOURCE_DIR}/src/cpp/fastdds/core/condition/WaitSetImpl.cpp
             ${PROJECT_SOURCE_DIR}/src/cpp/fastdds/core/policy/QosPolicyUtils.cpp
             ${PROJECT_SOURCE_DIR}/src/cpp/fastdds/domain/DomainParticipant.cpp

test/unittest/statistics/dds/CMakeLists.txt

@@ -113,6 +113,7 @@ if(NOT ((MSVC OR MSVC_IDE) AND EPROSIMA_INSTALLER))
                 ${PROJECT_SOURCE_DIR}/src/cpp/fastdds/core/condition/Condition.cpp
                 ${PROJECT_SOURCE_DIR}/src/cpp/fastdds/core/condition/ConditionNotifier.cpp
                 ${PROJECT_SOURCE_DIR}/src/cpp/fastdds/core/condition/StatusCondition.cpp
+                ${PROJECT_SOURCE_DIR}/src/cpp/fastdds/core/condition/StatusConditionImpl.cpp
                 ${PROJECT_SOURCE_DIR}/src/cpp/fastdds/core/condition/WaitSetImpl.cpp
                 ${PROJECT_SOURCE_DIR}/src/cpp/fastdds/core/policy/ParameterList.cpp
                 ${PROJECT_SOURCE_DIR}/src/cpp/fastdds/core/policy/QosPolicyUtils.cpp