interpolatorspline.h

Go to the documentation of this file.

// SPDX-FileCopyrightText: Copyright (C) 2017 swift Project Community / Contributors
// SPDX-License-Identifier: GPL-3.0-or-later OR LicenseRef-swift-pilot-client-1

 
#ifndef SWIFT_MISC_SIMULATION_INTERPOLATION_INTERPOLATORSPLINE_H
#define SWIFT_MISC_SIMULATION_INTERPOLATION_INTERPOLATORSPLINE_H
 
#include "misc/aviation/aircraftsituation.h"
#include "misc/simulation/interpolation/interpolant.h"
#include "misc/simulation/interpolation/interpolationlogger.h"
#include "misc/simulation/interpolation/interpolator.h"
#include "misc/swiftmiscexport.h"
 
namespace swift::misc::simulation
{
    class SWIFT_MISC_EXPORT CInterpolatorSpline : public CInterpolator
    {
        void anchor() override;
 
    public:
        CInterpolatorSpline(const aviation::CCallsign &callsign, ISimulationEnvironmentProvider *envProvider,
                            IInterpolationSetupProvider *setupProvider, IRemoteAircraftProvider *aircraftProvider,
                            CInterpolationLogger *logger = nullptr)
            : CInterpolator(callsign, envProvider, setupProvider, aircraftProvider, logger)
        {}

        struct SWIFT_MISC_EXPORT PosArray
        {
            void initToZero();

            static const PosArray &zeroPosArray();

            std::array<double, 3> x;
            std::array<double, 3> y;
            std::array<double, 3> z;
            std::array<double, 3> a;
            std::array<double, 3> gnd;
            std::array<double, 3> t;
            std::array<double, 3> dx;
            std::array<double, 3> dy;
            std::array<double, 3> dz;
            std::array<double, 3> da;
            std::array<double, 3> dgnd;

            int size() const { return static_cast<int>(x.size()); }
        };

        class SWIFT_MISC_EXPORT CInterpolant : public IInterpolant
        {
        public:
            CInterpolant() : m_pa(PosArray::zeroPosArray()) {}

            CInterpolant(const PosArray &pa, const physical_quantities::CLengthUnit &altitudeUnit,
                         const CInterpolatorLinearPbh &pbh);

            std::tuple<geo::CCoordinateGeodetic, aviation::CAltitude> interpolatePositionAndAltitude() const override;

            aviation::COnGroundInfo interpolateGroundFactor() const override;

            void setTimes(qint64 currentTimeMs, double timeFraction, qint64 interpolatedTimeMs);

            const PosArray &getPa() const { return m_pa; }

            const IInterpolatorPbh &pbh() const override { return m_pbh; }
 
        private:
            PosArray m_pa; 
            physical_quantities::CLengthUnit m_altitudeUnit;
            qint64 m_currentTimeMsSinceEpoc { -1 };
            CInterpolatorLinearPbh m_pbh; 
        };

        const IInterpolant &getInterpolant(SituationLog &log) override;
 
    private:
        bool updateElevations(bool canSkip);

        bool areAnyElevationsMissing() const;

        bool isAnySituationNearGroundRelevant() const;

        bool fillSituationsArray();

        static bool verifyInterpolationSituations(const aviation::CAircraftSituation &oldest,
                                                  const aviation::CAircraftSituation &newer,
                                                  const aviation::CAircraftSituation &latest,
                                                  const CInterpolationAndRenderingSetupPerCallsign &setup =
                                                      CInterpolationAndRenderingSetupPerCallsign::null());
 
        qint64 m_prevSampleAdjustedTime = 0; 
        qint64 m_nextSampleAdjustedTime = 0; 
        qint64 m_prevSampleTime = 0; 
        qint64 m_nextSampleTime = 0; 
        std::array<aviation::CAircraftSituation, 3> m_s; 
        CInterpolant m_interpolant;
    };
} // namespace swift::misc::simulation
 
#endif // SWIFT_MISC_SIMULATION_INTERPOLATION_INTERPOLATORSPLINE_H