correlator.hpp

Go to the documentation of this file.

 
#ifndef RTCTK_TELSUB_CORRELATOR_HPP
#define RTCTK_TELSUB_CORRELATOR_HPP
 
#include <memory>
#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(CorrelatorParams const& params,
                        std::unique_ptr<DdsWaitSetIf> dds_subscriber,
                        Alloc const& alloc = {});
 
    virtual std::error_code Poll(std::chrono::milliseconds timeout,
                                 DataSamplesView const*& samples) RTCTK_NOEXCEPT override;
 
    std::optional<unsigned long> GetLastSampleId() const RTCTK_NOEXCEPT override {
        return m_last_correlated_sample;
    }
    void Reset() RTCTK_NOEXCEPT override;
private:
    using ClockType = std::chrono::steady_clock;
    using TimePoint = ClockType::time_point;
 
    std::error_code TakeUntil(TimePoint until) noexcept;
 
    std::error_code CorrelateFirst(TimePoint until, DataSamplesView const*& samples) noexcept;
 
    std::error_code CorrelateSubsequent(TimePoint until, DataSamplesView const*& samples) noexcept;
 
    void Truncate(AgnosticDataSamples& samples) noexcept;
 
    CorrelatorParams m_params;
    std::unique_ptr<DdsWaitSetIf> m_dds_subscriber;
    AgnosticDataSamples& m_samples;
    std::optional<unsigned long> m_last_correlated_sample;
    TimePoint m_poll_until_time;
    DataSamplesView m_view;
    std::pmr::vector<size_t> m_indices;
};
 
}  // namespace rtctk::telSub
 
#endif  // #define RTCTK_TELSUB_CORRELATOR_HPP