SurveyMissionItem.h 17 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15
/****************************************************************************
 *
 *   (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 SurveyMissionItem_H
#define SurveyMissionItem_H

#include "ComplexMissionItem.h"
#include "MissionItem.h"
16
#include "SettingsFact.h"
17
#include "QGCLoggingCategory.h"
18
#include "QGCMapPolygon.h"
19 20 21 22 23 24 25 26 27 28

Q_DECLARE_LOGGING_CATEGORY(SurveyMissionItemLog)

class SurveyMissionItem : public ComplexMissionItem
{
    Q_OBJECT

public:
    SurveyMissionItem(Vehicle* vehicle, QObject* parent = NULL);

Don Gagne's avatar
Don Gagne committed
29
    Q_PROPERTY(Fact*                gridAltitude                READ gridAltitude                   CONSTANT)
30
    Q_PROPERTY(Fact*                gridAltitudeRelative        READ gridAltitudeRelative           CONSTANT)
Don Gagne's avatar
Don Gagne committed
31 32
    Q_PROPERTY(Fact*                gridAngle                   READ gridAngle                      CONSTANT)
    Q_PROPERTY(Fact*                gridSpacing                 READ gridSpacing                    CONSTANT)
DonLakeFlyer's avatar
DonLakeFlyer committed
33
    Q_PROPERTY(Fact*                gridEntryLocation           READ gridEntryLocation              CONSTANT)
Don Gagne's avatar
Don Gagne committed
34 35
    Q_PROPERTY(Fact*                turnaroundDist              READ turnaroundDist                 CONSTANT)
    Q_PROPERTY(Fact*                cameraTriggerDistance       READ cameraTriggerDistance          CONSTANT)
36 37
    Q_PROPERTY(Fact*                cameraTriggerInTurnaround   READ cameraTriggerInTurnaround      CONSTANT)
    Q_PROPERTY(Fact*                hoverAndCapture             READ hoverAndCapture                CONSTANT)
Don Gagne's avatar
Don Gagne committed
38 39 40 41 42 43 44 45
    Q_PROPERTY(Fact*                groundResolution            READ groundResolution               CONSTANT)
    Q_PROPERTY(Fact*                frontalOverlap              READ frontalOverlap                 CONSTANT)
    Q_PROPERTY(Fact*                sideOverlap                 READ sideOverlap                    CONSTANT)
    Q_PROPERTY(Fact*                cameraSensorWidth           READ cameraSensorWidth              CONSTANT)
    Q_PROPERTY(Fact*                cameraSensorHeight          READ cameraSensorHeight             CONSTANT)
    Q_PROPERTY(Fact*                cameraResolutionWidth       READ cameraResolutionWidth          CONSTANT)
    Q_PROPERTY(Fact*                cameraResolutionHeight      READ cameraResolutionHeight         CONSTANT)
    Q_PROPERTY(Fact*                cameraFocalLength           READ cameraFocalLength              CONSTANT)
46
    Q_PROPERTY(Fact*                cameraOrientationLandscape  READ cameraOrientationLandscape     CONSTANT)
47
    Q_PROPERTY(Fact*                fixedValueIsAltitude        READ fixedValueIsAltitude           CONSTANT)
48 49 50
    Q_PROPERTY(Fact*                manualGrid                  READ manualGrid                     CONSTANT)
    Q_PROPERTY(Fact*                camera                      READ camera                         CONSTANT)

51
    Q_PROPERTY(bool                 cameraOrientationFixed      MEMBER _cameraOrientationFixed      NOTIFY cameraOrientationFixedChanged)
DonLakeFlyer's avatar
DonLakeFlyer committed
52
    Q_PROPERTY(bool                 hoverAndCaptureAllowed      READ hoverAndCaptureAllowed         CONSTANT)
53
    Q_PROPERTY(bool                 refly90Degrees              READ refly90Degrees WRITE setRefly90Degrees NOTIFY refly90DegreesChanged)
54
    Q_PROPERTY(double               cameraMinTriggerInterval    MEMBER _cameraMinTriggerInterval    NOTIFY cameraMinTriggerIntervalChanged)
55

56
    Q_PROPERTY(double               timeBetweenShots            READ timeBetweenShots               NOTIFY timeBetweenShotsChanged)
Don Gagne's avatar
Don Gagne committed
57 58 59
    Q_PROPERTY(QVariantList         gridPoints                  READ gridPoints                     NOTIFY gridPointsChanged)
    Q_PROPERTY(int                  cameraShots                 READ cameraShots                    NOTIFY cameraShotsChanged)
    Q_PROPERTY(double               coveredArea                 READ coveredArea                    NOTIFY coveredAreaChanged)
60

61 62
    Q_PROPERTY(QGCMapPolygon*       mapPolygon                  READ mapPolygon                     CONSTANT)

63
    QVariantList gridPoints (void) { return _simpleGridPoints; }
64

65
    Fact* manualGrid                (void) { return &_manualGridFact; }
Don Gagne's avatar
Don Gagne committed
66
    Fact* gridAltitude              (void) { return &_gridAltitudeFact; }
67
    Fact* gridAltitudeRelative      (void) { return &_gridAltitudeRelativeFact; }
Don Gagne's avatar
Don Gagne committed
68 69
    Fact* gridAngle                 (void) { return &_gridAngleFact; }
    Fact* gridSpacing               (void) { return &_gridSpacingFact; }
DonLakeFlyer's avatar
DonLakeFlyer committed
70
    Fact* gridEntryLocation         (void) { return &_gridEntryLocationFact; }
Don Gagne's avatar
Don Gagne committed
71 72
    Fact* turnaroundDist            (void) { return &_turnaroundDistFact; }
    Fact* cameraTriggerDistance     (void) { return &_cameraTriggerDistanceFact; }
73 74
    Fact* cameraTriggerInTurnaround (void) { return &_cameraTriggerInTurnaroundFact; }
    Fact* hoverAndCapture           (void) { return &_hoverAndCaptureFact; }
Don Gagne's avatar
Don Gagne committed
75 76 77 78 79 80 81 82
    Fact* groundResolution          (void) { return &_groundResolutionFact; }
    Fact* frontalOverlap            (void) { return &_frontalOverlapFact; }
    Fact* sideOverlap               (void) { return &_sideOverlapFact; }
    Fact* cameraSensorWidth         (void) { return &_cameraSensorWidthFact; }
    Fact* cameraSensorHeight        (void) { return &_cameraSensorHeightFact; }
    Fact* cameraResolutionWidth     (void) { return &_cameraResolutionWidthFact; }
    Fact* cameraResolutionHeight    (void) { return &_cameraResolutionHeightFact; }
    Fact* cameraFocalLength         (void) { return &_cameraFocalLengthFact; }
83 84 85
    Fact* cameraOrientationLandscape(void) { return &_cameraOrientationLandscapeFact; }
    Fact* fixedValueIsAltitude      (void) { return &_fixedValueIsAltitudeFact; }
    Fact* camera                    (void) { return &_cameraFact; }
86

87 88 89 90 91 92
    int             cameraShots             (void) const;
    double          coveredArea             (void) const { return _coveredArea; }
    double          timeBetweenShots        (void) const;
    bool            hoverAndCaptureAllowed  (void) const;
    bool            refly90Degrees          (void) const { return _refly90Degrees; }
    QGCMapPolygon*  mapPolygon              (void) { return &_mapPolygon; }
93 94

    void setRefly90Degrees(bool refly90Degrees);
95 96 97 98

    // Overrides from ComplexMissionItem

    double              complexDistance     (void) const final { return _surveyDistance; }
99
    QGCGeoBoundingCube  boundingCube        (void) const final { return _boundingCube; }
100
    double              additionalTimeDelay (void) const final { return _additionalFlightDelaySeconds; }
101
    int                 lastSequenceNumber  (void) const final;
Don Gagne's avatar
Don Gagne committed
102
    bool                load                (const QJsonObject& complexObject, int sequenceNumber, QString& errorString) final;
103
    double              greatestDistanceTo  (const QGeoCoordinate &other) const final;
104
    QString             mapVisualQML        (void) const final { return QStringLiteral("SurveyMapVisual.qml"); }
105

106 107 108 109 110 111
    // 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;
112
    bool            specifiesAltitudeOnly   (void) const final { return false; }
113 114 115 116 117 118
    QString         commandDescription      (void) const final { return "Survey"; }
    QString         commandName             (void) const final { return "Survey"; }
    QString         abbreviation            (void) const final { return "S"; }
    QGeoCoordinate  coordinate              (void) const final { return _coordinate; }
    QGeoCoordinate  exitCoordinate          (void) const final { return _exitCoordinate; }
    int             sequenceNumber          (void) const final { return _sequenceNumber; }
DonLakeFlyer's avatar
DonLakeFlyer committed
119 120
    double          specifiedFlightSpeed    (void) final { return std::numeric_limits<double>::quiet_NaN(); }
    double          specifiedGimbalYaw      (void) final { return std::numeric_limits<double>::quiet_NaN(); }
121
    double          specifiedGimbalPitch    (void) final { return std::numeric_limits<double>::quiet_NaN(); }
122
    void            appendMissionItems      (QList<MissionItem*>& items, QObject* missionItemParent) final;
DonLakeFlyer's avatar
DonLakeFlyer committed
123
    void            setMissionFlightStatus  (MissionController::MissionFlightStatus_t& missionFlightStatus) final;
DonLakeFlyer's avatar
DonLakeFlyer committed
124
    void            applyNewAltitude        (double newAltitude) final;
125

126 127
    bool coordinateHasRelativeAltitude      (void) const final { return _gridAltitudeRelativeFact.rawValue().toBool(); }
    bool exitCoordinateHasRelativeAltitude  (void) const final { return _gridAltitudeRelativeFact.rawValue().toBool(); }
128 129 130 131 132
    bool exitCoordinateSameAsEntry          (void) const final { return false; }

    void setDirty           (bool dirty) final;
    void setCoordinate      (const QGeoCoordinate& coordinate) final;
    void setSequenceNumber  (int sequenceNumber) final;
133
    void setTurnaroundDist  (double dist) { _turnaroundDistFact.setRawValue(dist); }
134
    void save               (QJsonArray&  missionItems) final;
135

136 137 138 139 140 141 142 143
    // Must match json spec for GridEntryLocation
    enum EntryLocation {
        EntryLocationTopLeft,
        EntryLocationTopRight,
        EntryLocationBottomLeft,
        EntryLocationBottomRight,
    };

Don Gagne's avatar
Don Gagne committed
144 145
    static const char* jsonComplexItemTypeValue;

146 147 148 149 150 151
    static const char* settingsGroup;
    static const char* manualGridName;
    static const char* gridAltitudeName;
    static const char* gridAltitudeRelativeName;
    static const char* gridAngleName;
    static const char* gridSpacingName;
DonLakeFlyer's avatar
DonLakeFlyer committed
152
    static const char* gridEntryLocationName;
153 154
    static const char* turnaroundDistName;
    static const char* cameraTriggerDistanceName;
155 156
    static const char* cameraTriggerInTurnaroundName;
    static const char* hoverAndCaptureName;
157 158 159 160 161 162 163 164 165 166 167 168 169
    static const char* groundResolutionName;
    static const char* frontalOverlapName;
    static const char* sideOverlapName;
    static const char* cameraSensorWidthName;
    static const char* cameraSensorHeightName;
    static const char* cameraResolutionWidthName;
    static const char* cameraResolutionHeightName;
    static const char* cameraFocalLengthName;
    static const char* cameraTriggerName;
    static const char* cameraOrientationLandscapeName;
    static const char* fixedValueIsAltitudeName;
    static const char* cameraName;

170
signals:
171 172 173 174 175 176 177 178 179
    void gridPointsChanged                  (void);
    void cameraShotsChanged                 (int cameraShots);
    void coveredAreaChanged                 (double coveredArea);
    void cameraValueChanged                 (void);
    void gridTypeChanged                    (QString gridType);
    void timeBetweenShotsChanged            (void);
    void cameraOrientationFixedChanged      (bool cameraOrientationFixed);
    void refly90DegreesChanged              (bool refly90Degrees);
    void cameraMinTriggerIntervalChanged    (double cameraMinTriggerInterval);
180 181

private slots:
182
    void _setDirty(void);
183 184
    void _polygonDirtyChanged(bool dirty);
    void _clearInternal(void);
185 186

private:
187 188 189
    enum CameraTriggerCode {
        CameraTriggerNone,
        CameraTriggerOn,
DonLakeFlyer's avatar
DonLakeFlyer committed
190 191
        CameraTriggerOff,
        CameraTriggerHoverAndCapture
192 193
    };

194 195
    void _setExitCoordinate(const QGeoCoordinate& coordinate);
    void _generateGrid(void);
196
    void _updateCoordinateAltitude(void);
197
    int _gridGenerator(const QList<QPointF>& polygonPoints, QList<QList<QPointF>>& transectSegments, bool refly);
198 199 200 201 202
    QPointF _rotatePoint(const QPointF& point, const QPointF& origin, double angle);
    void _intersectLinesWithRect(const QList<QLineF>& lineList, const QRectF& boundRect, QList<QLineF>& resultLines);
    void _intersectLinesWithPolygon(const QList<QLineF>& lineList, const QPolygonF& polygon, QList<QLineF>& resultLines);
    void _adjustLineDirection(const QList<QLineF>& lineList, QList<QLineF>& resultLines);
    void _setSurveyDistance(double surveyDistance);
203
    void _setBoundingCube(QGCGeoBoundingCube bc);
204 205
    void _setCameraShots(int cameraShots);
    void _setCoveredArea(double coveredArea);
Don Gagne's avatar
Don Gagne committed
206
    void _cameraValueChanged(void);
207
    int _appendWaypointToMission(QList<MissionItem*>& items, int seqNum, QGeoCoordinate& coord, CameraTriggerCode cameraTrigger, QObject* missionItemParent);
DonLakeFlyer's avatar
DonLakeFlyer committed
208 209 210 211 212 213 214
    bool _nextTransectCoord(const QList<QGeoCoordinate>& transectPoints, int pointIndex, QGeoCoordinate& coord);
    double _triggerDistance(void) const;
    bool _triggerCamera(void) const;
    bool _imagesEverywhere(void) const;
    bool _hoverAndCaptureEnabled(void) const;
    bool _hasTurnaround(void) const;
    double _turnaroundDistance(void) const;
215 216
    void _convertTransectToGeo(const QList<QList<QPointF>>& transectSegmentsNED, const QGeoCoordinate& tangentOrigin, QList<QList<QGeoCoordinate>>& transectSegmentsGeo);
    bool _appendMissionItemsWorker(QList<MissionItem*>& items, QObject* missionItemParent, int& seqNum, bool hasRefly, bool buildRefly);
DonLakeFlyer's avatar
DonLakeFlyer committed
217
    void _optimizeTransectsForShortestDistance(const QGeoCoordinate& distanceCoord, QList<QList<QGeoCoordinate>>& transects);
218
    void _appendGridPointsFromTransects(QList<QList<QGeoCoordinate>>& rgTransectSegments);
219 220 221
    qreal _ccw(QPointF pt1, QPointF pt2, QPointF pt3);
    qreal _dp(QPointF pt1, QPointF pt2);
    void _swapPoints(QList<QPointF>& points, int index1, int index2);
DonLakeFlyer's avatar
DonLakeFlyer committed
222 223 224 225 226
    void _reverseTransectOrder(QList<QList<QGeoCoordinate>>& transects);
    void _reverseInternalTransectPoints(QList<QList<QGeoCoordinate>>& transects);
    void _adjustTransectsToEntryPointLocation(QList<QList<QGeoCoordinate>>& transects);
    bool _gridAngleIsNorthSouthTransects();
    double _clampGridAngle90(double gridAngle);
227
    int _calcMissionCommandCount(QList<QList<QGeoCoordinate>>& transectSegments);
228
    void _calcBoundingCube();
229 230 231

    int                             _sequenceNumber;
    bool                            _dirty;
232
    QGCMapPolygon                   _mapPolygon;
233
    QVariantList                    _simpleGridPoints;      ///< Grid points for drawing simple grid visuals
DonLakeFlyer's avatar
DonLakeFlyer committed
234
    QList<QList<QGeoCoordinate>>    _transectSegments;      ///< Internal transect segments including grid exit, turnaround and internal camera points
235
    QList<QList<QGeoCoordinate>>    _reflyTransectSegments; ///< Refly segments
236 237 238
    QGeoCoordinate                  _coordinate;
    QGeoCoordinate                  _exitCoordinate;
    bool                            _cameraOrientationFixed;
DonLakeFlyer's avatar
DonLakeFlyer committed
239
    int                             _missionCommandCount;
240
    bool                            _refly90Degrees;
241
    double                          _additionalFlightDelaySeconds;
242
    double                          _cameraMinTriggerInterval;
Don Gagne's avatar
Don Gagne committed
243

244
    bool            _ignoreRecalc;
Don Gagne's avatar
Don Gagne committed
245 246 247
    double          _surveyDistance;
    int             _cameraShots;
    double          _coveredArea;
248 249
    double          _timeBetweenShots;
    double          _cruiseSpeed;
250

251
    QGCGeoBoundingCube _boundingCube;
252 253 254 255 256 257 258
    QMap<QString, FactMetaData*> _metaDataMap;

    SettingsFact    _manualGridFact;
    SettingsFact    _gridAltitudeFact;
    SettingsFact    _gridAltitudeRelativeFact;
    SettingsFact    _gridAngleFact;
    SettingsFact    _gridSpacingFact;
DonLakeFlyer's avatar
DonLakeFlyer committed
259
    SettingsFact    _gridEntryLocationFact;
260 261
    SettingsFact    _turnaroundDistFact;
    SettingsFact    _cameraTriggerDistanceFact;
262 263
    SettingsFact    _cameraTriggerInTurnaroundFact;
    SettingsFact    _hoverAndCaptureFact;
264 265 266 267 268 269 270 271 272 273 274
    SettingsFact    _groundResolutionFact;
    SettingsFact    _frontalOverlapFact;
    SettingsFact    _sideOverlapFact;
    SettingsFact    _cameraSensorWidthFact;
    SettingsFact    _cameraSensorHeightFact;
    SettingsFact    _cameraResolutionWidthFact;
    SettingsFact    _cameraResolutionHeightFact;
    SettingsFact    _cameraFocalLengthFact;
    SettingsFact    _cameraOrientationLandscapeFact;
    SettingsFact    _fixedValueIsAltitudeFact;
    SettingsFact    _cameraFact;
275

Don Gagne's avatar
Don Gagne committed
276
    static const char* _jsonGridObjectKey;
277 278 279 280
    static const char* _jsonGridAltitudeKey;
    static const char* _jsonGridAltitudeRelativeKey;
    static const char* _jsonGridAngleKey;
    static const char* _jsonGridSpacingKey;
DonLakeFlyer's avatar
DonLakeFlyer committed
281
    static const char* _jsonGridEntryLocationKey;
Andreas Bircher's avatar
Andreas Bircher committed
282
    static const char* _jsonTurnaroundDistKey;
283
    static const char* _jsonCameraTriggerDistanceKey;
284 285
    static const char* _jsonCameraTriggerInTurnaroundKey;
    static const char* _jsonHoverAndCaptureKey;
Don Gagne's avatar
Don Gagne committed
286 287 288 289 290 291 292 293
    static const char* _jsonGroundResolutionKey;
    static const char* _jsonFrontalOverlapKey;
    static const char* _jsonSideOverlapKey;
    static const char* _jsonCameraSensorWidthKey;
    static const char* _jsonCameraSensorHeightKey;
    static const char* _jsonCameraResolutionWidthKey;
    static const char* _jsonCameraResolutionHeightKey;
    static const char* _jsonCameraFocalLengthKey;
294
    static const char* _jsonCameraMinTriggerIntervalKey;
Don Gagne's avatar
Don Gagne committed
295 296 297 298 299
    static const char* _jsonManualGridKey;
    static const char* _jsonCameraObjectKey;
    static const char* _jsonCameraNameKey;
    static const char* _jsonCameraOrientationLandscapeKey;
    static const char* _jsonFixedValueIsAltitudeKey;
300
    static const char* _jsonRefly90DegreesKey;
301

DonLakeFlyer's avatar
DonLakeFlyer committed
302
    static const int _hoverAndCaptureDelaySeconds = 4;
303 304 305
};

#endif