refs #863 Added cubic spline interpolator.

2026-04-05 17:35:34 +08:00 · 2017-02-05 01:00:02 +00:00
parent 4cc5643340
commit 8d351d8279
6 changed files with 250 additions and 9 deletions
--- a/src/blackmisc/simulation/interpolatorspline.h
+++ b/src/blackmisc/simulation/interpolatorspline.h
@@ -0,0 +1,74 @@
+/* Copyright (C) 2017
+ * swift project Community / Contributors
+ *
+ * This file is part of swift project. It is subject to the license terms in the LICENSE file found in the top-level
+ * directory of this distribution and at http://www.swift-project.org/license.html. No part of swift project,
+ * including this file, may be copied, modified, propagated, or distributed except according to the terms
+ * contained in the LICENSE file.
+ */
+
+//! \file
+
+#ifndef BLACKMISC_SIMULATION_INTERPOLATORSPLINE_H
+#define BLACKMISC_SIMULATION_INTERPOLATORSPLINE_H
+
+#include "blackmisc/simulation/interpolator.h"
+#include "blackmisc/blackmiscexport.h"
+#include "blackmisc/aviation/aircraftsituation.h"
+#include <QString>
+#include <QtGlobal>
+
+namespace BlackMisc
+{
+    namespace Simulation
+    {
+        //! Cubic spline interpolator
+        class BLACKMISC_EXPORT CInterpolatorSpline : public CInterpolator<CInterpolatorSpline>
+        {
+            Q_OBJECT
+
+        public:
+            //! Constructor
+            CInterpolatorSpline(QObject *parent = nullptr) :
+                CInterpolator("CInterpolatorSpline", parent)
+            {}
+
+            //! Cubic function that performs the actual interpolation
+            class Interpolant
+            {
+            public:
+                //! Constructor
+                Interpolant(const CInterpolatorSpline &interpolator, qint64 time) : i(interpolator), currentTimeMsSinceEpoc(time) {}
+
+                //! Perform the interpolation
+                //! @{
+                Geo::CCoordinateGeodetic interpolatePosition(const CInterpolationAndRenderingSetup &setup, const CInterpolationHints &hints) const;
+                Aviation::CAltitude interpolateAltitude(const CInterpolationAndRenderingSetup &setup, const CInterpolationHints &hints) const;
+                //! @}
+
+                //! Interpolator for pitch, bank, heading, groundspeed
+                CInterpolatorPbh pbh() const { return i.pbh; }
+
+            private:
+               const CInterpolatorSpline &i;
+               qint64 currentTimeMsSinceEpoc = 0;
+            };
+
+            //! Strategy used by CInterpolator::getInterpolatedSituation
+            Interpolant getInterpolant(qint64 currentTimeMsSinceEpoc, const CInterpolationAndRenderingSetup &setup,
+                const CInterpolationHints &hints, CInterpolationStatus &status, InterpolationLog &log);
+
+            //! Log category
+            static QString getLogCategory() { return "swift.interpolatorspline"; }
+
+        private:
+            qint64 m_prevSampleTime = 0;
+            qint64 m_nextSampleTime = 0;
+            PhysicalQuantities::CLengthUnit m_altitudeUnit;
+            std::array<double, 3> x, y, z, a, t, dx, dy, dz, da;
+            CInterpolatorPbh pbh;
+        };
+    }
+}
+
+#endif