FixedWingLandingComplexItem.h 8.05 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24
/****************************************************************************
 *
 *   (c) 2009-2016 QGROUNDCONTROL PROJECT <http://www.qgroundcontrol.org>
 *
 * QGroundControl is licensed according to the terms in the file
 * COPYING.md in the root of the source code directory.
 *
 ****************************************************************************/

#ifndef FixedWingLandingComplexItem_H
#define FixedWingLandingComplexItem_H

#include "ComplexMissionItem.h"
#include "MissionItem.h"
#include "Fact.h"
#include "QGCLoggingCategory.h"

Q_DECLARE_LOGGING_CATEGORY(FixedWingLandingComplexItemLog)

class FixedWingLandingComplexItem : public ComplexMissionItem
{
    Q_OBJECT

public:
25
    FixedWingLandingComplexItem(Vehicle* vehicle, QObject* parent = NULL);
26

27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50
    Q_PROPERTY(Fact*            loiterAltitude          READ    loiterAltitude                                                  CONSTANT)
    Q_PROPERTY(Fact*            loiterRadius            READ    loiterRadius                                                    CONSTANT)
    Q_PROPERTY(Fact*            landingAltitude         READ    landingAltitude                                                 CONSTANT)
    Q_PROPERTY(Fact*            landingDistance         READ    landingDistance                                                 CONSTANT)
    Q_PROPERTY(Fact*            landingHeading          READ    landingHeading                                                  CONSTANT)
    Q_PROPERTY(bool             loiterClockwise         MEMBER  _loiterClockwise                                                NOTIFY loiterClockwiseChanged)
    Q_PROPERTY(bool             loiterAltitudeRelative  MEMBER  _loiterAltitudeRelative                                         NOTIFY loiterAltitudeRelativeChanged)
    Q_PROPERTY(bool             landingAltitudeRelative MEMBER  _landingAltitudeRelative                                        NOTIFY landingAltitudeRelativeChanged)
    Q_PROPERTY(QGeoCoordinate   loiterCoordinate        READ    loiterCoordinate            WRITE setLoiterCoordinate           NOTIFY loiterCoordinateChanged)
    Q_PROPERTY(QGeoCoordinate   loiterTangentCoordinate READ    loiterTangentCoordinate                                         NOTIFY loiterTangentCoordinateChanged)
    Q_PROPERTY(QGeoCoordinate   landingCoordinate       READ    landingCoordinate           WRITE setLandingCoordinate          NOTIFY landingCoordinateChanged)
    Q_PROPERTY(bool             landingCoordSet         MEMBER _landingCoordSet                                                 NOTIFY landingCoordSetChanged)

    Fact*           loiterAltitude          (void) { return &_loiterAltitudeFact; }
    Fact*           loiterRadius            (void) { return &_loiterRadiusFact; }
    Fact*           landingAltitude         (void) { return &_landingAltitudeFact; }
    Fact*           landingDistance         (void) { return &_landingDistanceFact; }
    Fact*           landingHeading          (void) { return &_landingHeadingFact; }
    QGeoCoordinate  landingCoordinate       (void) const { return _landingCoordinate; }
    QGeoCoordinate  loiterCoordinate        (void) const { return _loiterCoordinate; }
    QGeoCoordinate  loiterTangentCoordinate (void) const { return _loiterTangentCoordinate; }

    void setLandingCoordinate       (const QGeoCoordinate& coordinate);
    void setLoiterCoordinate        (const QGeoCoordinate& coordinate);
51

52 53 54
    /// Scans the loaded items for a landing pattern complex item
    static bool scanForItem(QmlObjectListModel* visualItems, Vehicle* vehicle);

55 56 57 58 59 60
    // Overrides from ComplexMissionItem

    double              complexDistance     (void) const final;
    int                 lastSequenceNumber  (void) const final;
    bool                load                (const QJsonObject& complexObject, int sequenceNumber, QString& errorString) final;
    double              greatestDistanceTo  (const QGeoCoordinate &other) const final;
61
    QString             mapVisualQML        (void) const final { return QStringLiteral("FWLandingPatternMapVisual.qml"); }
62 63 64 65 66 67 68

    // Overrides from VisualMissionItem

    bool            dirty                   (void) const final { return _dirty; }
    bool            isSimpleItem            (void) const final { return false; }
    bool            isStandaloneCoordinate  (void) const final { return false; }
    bool            specifiesCoordinate     (void) const final;
69
    bool            specifiesAltitudeOnly   (void) const final { return false; }
70 71 72
    QString         commandDescription      (void) const final { return "Landing Pattern"; }
    QString         commandName             (void) const final { return "Landing Pattern"; }
    QString         abbreviation            (void) const final { return "L"; }
73 74
    QGeoCoordinate  coordinate              (void) const final { return _loiterCoordinate; }
    QGeoCoordinate  exitCoordinate          (void) const final { return _landingCoordinate; }
75
    int             sequenceNumber          (void) const final { return _sequenceNumber; }
DonLakeFlyer's avatar
DonLakeFlyer committed
76 77
    double          specifiedFlightSpeed    (void) final { return std::numeric_limits<double>::quiet_NaN(); }
    double          specifiedGimbalYaw      (void) final { return std::numeric_limits<double>::quiet_NaN(); }
78
    void            appendMissionItems      (QList<MissionItem*>& items, QObject* missionItemParent) final;
DonLakeFlyer's avatar
DonLakeFlyer committed
79
    void            applyNewAltitude        (double newAltitude) final;
80

81 82 83
    bool coordinateHasRelativeAltitude      (void) const final { return _loiterAltitudeRelative; }
    bool exitCoordinateHasRelativeAltitude  (void) const final { return _landingAltitudeRelative; }
    bool exitCoordinateSameAsEntry          (void) const final { return false; }
84 85

    void setDirty           (bool dirty) final;
86
    void setCoordinate      (const QGeoCoordinate& coordinate) final { setLoiterCoordinate(coordinate); }
87
    void setSequenceNumber  (int sequenceNumber) final;
88
    void save               (QJsonArray&  missionItems) final;
89 90 91 92

    static const char* jsonComplexItemTypeValue;

signals:
93
    void loiterCoordinateChanged        (QGeoCoordinate coordinate);
94
    void loiterTangentCoordinateChanged (QGeoCoordinate coordinate);
95 96 97 98 99
    void landingCoordinateChanged       (QGeoCoordinate coordinate);
    void landingCoordSetChanged         (bool landingCoordSet);
    void loiterClockwiseChanged         (bool loiterClockwise);
    void loiterAltitudeRelativeChanged  (bool loiterAltitudeRelative);
    void landingAltitudeRelativeChanged (bool loiterAltitudeRelative);
100 101

private slots:
102 103 104
    void _recalcFromHeadingAndDistanceChange(void);
    void _recalcFromCoordinateChange(void);
    void _recalcFromRadiusChange(void);
105 106
    void _updateLoiterCoodinateAltitudeFromFact(void);
    void _updateLandingCoodinateAltitudeFromFact(void);
107 108
    double _mathematicAngleToHeading(double angle);
    double _headingToMathematicAngle(double heading);
109
    void _setDirty(void);
110 111

private:
112
    QPointF _rotatePoint(const QPointF& point, const QPointF& origin, double angle);
113 114 115

    int             _sequenceNumber;
    bool            _dirty;
116
    QGeoCoordinate  _loiterCoordinate;
117
    QGeoCoordinate  _loiterTangentCoordinate;
118 119 120
    QGeoCoordinate  _landingCoordinate;
    bool            _landingCoordSet;
    bool            _ignoreRecalcSignals;
121

122
    Fact            _landingDistanceFact;
123 124 125
    Fact            _loiterAltitudeFact;
    Fact            _loiterRadiusFact;
    Fact            _landingHeadingFact;
126
    Fact            _landingAltitudeFact;
127

128 129 130
    bool            _loiterClockwise;
    bool            _loiterAltitudeRelative;
    bool            _landingAltitudeRelative;
131

132
    static QMap<QString, FactMetaData*> _metaDataMap;
133 134 135 136 137

    static const char* _loiterToLandDistanceName;
    static const char* _loiterAltitudeName;
    static const char* _loiterRadiusName;
    static const char* _landingHeadingName;
138
    static const char* _landingAltitudeName;
139 140 141 142 143 144 145

    static const char* _jsonLoiterCoordinateKey;
    static const char* _jsonLoiterRadiusKey;
    static const char* _jsonLoiterClockwiseKey;
    static const char* _jsonLoiterAltitudeRelativeKey;
    static const char* _jsonLandingCoordinateKey;
    static const char* _jsonLandingAltitudeRelativeKey;
146 147 148
};

#endif