correlator.hpp

Go to the documentation of this file.

#ifndef RTCTK_TELSUB_CORRELATOR_HPP
#define RTCTK_TELSUB_CORRELATOR_HPP
 
#include <memory>
#include <rtctk/componentFramework/componentMetricsIf.hpp>
#include <rtctk/telSub/correlatorIf.hpp>
#include <rtctk/telSub/ddsWaitSetIf.hpp>
 
namespace rtctk::telSub {

class Correlator final : public CorrelatorIf {
public:
    using Alloc = std::pmr::polymorphic_allocator<std::byte>;

    explicit Correlator(const CorrelatorParams& params,
                        std::unique_ptr<DdsWaitSetIf> dds_subscriber,
                        componentFramework::ComponentMetricsIf& metrics,
                        const Alloc& alloc = {});

    std::optional<CorrelationError> Poll(std::chrono::milliseconds timeout,
                                         const DataSamplesView*& samples) noexcept override;
 
    std::optional<std::uint32_t> GetLastSampleId() const noexcept override {
        return m_last_correlated_sample;
    }
    void Reset() noexcept override;
 
    void CheckDdsConnections() override;
 
private:
    using ClockType = std::chrono::steady_clock;
    using TimePoint = ClockType::time_point;

    std::optional<CorrelationError> TakeUntil(TimePoint until) noexcept;

    std::optional<CorrelationError>
    CorrelateFirst(TimePoint until, const DataSamplesView*& samples) noexcept;

    std::optional<CorrelationError>
    CorrelateSubsequent(TimePoint until, const DataSamplesView*& samples) noexcept;

    void Truncate(AgnosticDataSamples& samples) noexcept;
 
    log4cplus::Logger& m_logger;
    CorrelatorParams m_params;
    std::unique_ptr<DdsWaitSetIf> m_dds_subscriber;
    componentFramework::ComponentMetricsIf& m_metrics;
    AgnosticDataSamples& m_samples;
    std::optional<std::uint32_t> m_last_correlated_sample;
    TimePoint m_poll_until_time;
    DataSamplesView m_view;
    std::pmr::map<std::string, size_t> m_indices;
};
 
}  // namespace rtctk::telSub
 
#endif  // RTCTK_TELSUB_CORRELATOR_HPP