ptp_doppler.h

// Copyright 2024-2025 The Aerospace Corporation.
// This file is a part of SatCat5, licensed under CERN-OHL-W v2 or later.
// Doppler Precision Time Protocol (Doppler-PTP)
 
#pragma once
 
#include <satcat5/ptp_filters.h>
#include <satcat5/ptp_tlv.h>
#include <satcat5/timeref.h>
 
namespace satcat5 {
    namespace ptp {
        class DopplerTlv : public satcat5::ptp::TlvHandler {
        public:
            explicit DopplerTlv(satcat5::ptp::Client* client);
 
            inline void add_filter(satcat5::ptp::Filter* filter)
                { m_predict.add_filter(filter); }
 
            inline bool get_tcomp_en() const
                { return m_tcomp; }
 
            inline void set_tcomp_en(bool enable)
                { m_tcomp = enable; }
 
            inline s64 get_velocity() const
                { return m_predict.predict(0); }
 
            inline s64 get_acceleration() const
                { return m_predict.predict(1000000) - m_predict.predict(0); }
 
            // Required TlvHandler API.
            bool tlv_rcvd(
                const satcat5::ptp::Header& hdr,
                const satcat5::ptp::TlvHeader& tlv,
                satcat5::io::LimitedRead& rd) override;
            unsigned tlv_send(
                const satcat5::ptp::Header& hdr,
                satcat5::io::Writeable* wr) override;
            void tlv_meas(satcat5::ptp::Measurement& meas) override;
 
        protected:
            satcat5::ptp::LinearPrediction m_predict;
            s64 m_dstamp;
            satcat5::util::TimeVal m_tref;
            bool m_tcomp;
        };
 
        class DopplerSimple : public satcat5::ptp::DopplerTlv {
        public:
            explicit DopplerSimple(satcat5::ptp::Client* client);
 
        protected:
            satcat5::ptp::AmplitudeReject m_ampl;
            satcat5::ptp::ControllerPI m_ctrl;
        };
    }
}