[FSD] Add slowfast and stopped packets for Velocity

src/blackcore/fsd/visualpilotdatastopped.h

@@ -0,0 +1,77 @@
+/* Copyright (C) 2019
+ * 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. 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 BLACKCORE_FSD_VISUALPILOTDATASTOPPED_H
+#define BLACKCORE_FSD_VISUALPILOTDATASTOPPED_H
+
+#include "messagebase.h"
+#include "enums.h"
+
+namespace BlackCore::Fsd
+{
+    class VisualPilotDataUpdate;
+
+    //! VisualPilotDataUpdate with velocity assumed to be zero.
+    class BLACKCORE_EXPORT VisualPilotDataStopped : public MessageBase
+    {
+    public:
+        //! Constructor
+        VisualPilotDataStopped(const QString &sender, double latitude, double longitude, double altitudeTrue, double heightAgl,
+                                double pitch, double bank, double heading, double noseGearAngle = 0.0);
+
+        //! Message converted to tokens
+        QStringList toTokens() const;
+
+        //! Construct from tokens
+        static VisualPilotDataStopped fromTokens(const QStringList &tokens);
+
+        //! PDU identifier
+        static QString pdu() { return "#ST"; }
+
+        //! Return a regular visual update with the same values
+        VisualPilotDataUpdate toUpdate() const;
+
+        //! Properties
+        //! @{
+        double m_latitude      = 0.0;
+        double m_longitude     = 0.0;
+        double m_altitudeTrue  = 0.0;
+        double m_heightAgl     = 0.0;
+        double m_pitch         = 0.0;
+        double m_bank          = 0.0;
+        double m_heading       = 0.0;
+        double m_noseGearAngle = 0.0;
+        //! @}
+
+    private:
+        VisualPilotDataStopped();
+    };
+
+    //! Equal to operator
+    inline bool operator==(const VisualPilotDataStopped &lhs, const VisualPilotDataStopped &rhs)
+    {
+        return  qFuzzyCompare(lhs.m_latitude, rhs.m_latitude) &&
+                qFuzzyCompare(lhs.m_longitude, rhs.m_longitude) &&
+                qFuzzyCompare(lhs.m_altitudeTrue, rhs.m_altitudeTrue) &&
+                qFuzzyCompare(lhs.m_heightAgl, rhs.m_heightAgl) &&
+                qFuzzyCompare(lhs.m_pitch, rhs.m_pitch) &&
+                qFuzzyCompare(lhs.m_bank, rhs.m_bank) &&
+                qFuzzyCompare(lhs.m_heading, rhs.m_heading) &&
+                qFuzzyCompare(lhs.m_noseGearAngle, rhs.m_noseGearAngle);
+    }
+
+    //! Not equal to operator
+    inline bool operator!=(const VisualPilotDataStopped &lhs, const VisualPilotDataStopped &rhs)
+    {
+        return !(lhs == rhs);
+    }
+}
+
+#endif // guard