TransectStyleComplexItem.h

Go to the documentation of this file.

#pragma once
 
#include "ComplexMissionItem.h"
#include "MissionItem.h"
#include "SettingsFact.h"
#include "QGCMapPolygon.h"
#include "CameraCalc.h"
#include "TerrainQuery.h"
 
class PlanMasterController;
 
class TransectStyleComplexItem : public ComplexMissionItem
{
    Q_OBJECT
 
public:
    TransectStyleComplexItem(PlanMasterController* masterController, bool flyView, QString settignsGroup);
 
    Q_PROPERTY(QGCMapPolygon*   surveyAreaPolygon           READ surveyAreaPolygon                                  CONSTANT)
    Q_PROPERTY(CameraCalc*      cameraCalc                  READ cameraCalc                                         CONSTANT)
    Q_PROPERTY(Fact*            turnAroundDistance          READ turnAroundDistance                                 CONSTANT)
    Q_PROPERTY(Fact*            cameraTriggerInTurnAround   READ cameraTriggerInTurnAround                          CONSTANT)
    Q_PROPERTY(Fact*            hoverAndCapture             READ hoverAndCapture                                    CONSTANT)
    Q_PROPERTY(Fact*            refly90Degrees              READ refly90Degrees                                     CONSTANT)
 
    Q_PROPERTY(int              cameraShots                 READ cameraShots                                        NOTIFY cameraShotsChanged)
    Q_PROPERTY(double           timeBetweenShots            READ timeBetweenShots                                   NOTIFY timeBetweenShotsChanged)
    Q_PROPERTY(double           coveredArea                 READ coveredArea                                        NOTIFY coveredAreaChanged)
    Q_PROPERTY(bool             hoverAndCaptureAllowed      READ hoverAndCaptureAllowed                             CONSTANT)
    Q_PROPERTY(QVariantList     visualTransectPoints        READ visualTransectPoints                               NOTIFY visualTransectPointsChanged)
 
    Q_PROPERTY(Fact*            terrainAdjustTolerance      READ terrainAdjustTolerance                             CONSTANT)
    Q_PROPERTY(Fact*            terrainAdjustMaxDescentRate READ terrainAdjustMaxDescentRate                        CONSTANT)
    Q_PROPERTY(Fact*            terrainAdjustMaxClimbRate   READ terrainAdjustMaxClimbRate                          CONSTANT)
 
    QGCMapPolygon*  surveyAreaPolygon   (void) { return &_surveyAreaPolygon; }
    CameraCalc*     cameraCalc          (void) { return &_cameraCalc; }
    QVariantList    visualTransectPoints(void) { return _visualTransectPoints; }
 
    Fact* turnAroundDistance            (void) { return &_turnAroundDistanceFact; }
    Fact* cameraTriggerInTurnAround     (void) { return &_cameraTriggerInTurnAroundFact; }
    Fact* hoverAndCapture               (void) { return &_hoverAndCaptureFact; }
    Fact* refly90Degrees                (void) { return &_refly90DegreesFact; }
    Fact* terrainAdjustTolerance        (void) { return &_terrainAdjustToleranceFact; }
    Fact* terrainAdjustMaxDescentRate   (void) { return &_terrainAdjustMaxDescentRateFact; }
    Fact* terrainAdjustMaxClimbRate     (void) { return &_terrainAdjustMaxClimbRateFact; }
 
    const Fact* hoverAndCapture         (void) const { return &_hoverAndCaptureFact; }
 
    int             cameraShots             (void) const { return _cameraShots; }
    double          coveredArea             (void) const;
    bool            hoverAndCaptureAllowed  (void) const;
 
    virtual double  timeBetweenShots        (void) { return 0; } // Most be overridden. Implementation here is needed for unit testing.
 
    double  triggerDistance         (void) const { return _cameraCalc.adjustedFootprintFrontal()->rawValue().toDouble(); }
    bool    hoverAndCaptureEnabled  (void) const { return hoverAndCapture()->rawValue().toBool(); }
    bool    triggerCamera           (void) const { return triggerDistance() != 0; }
 
    // Used internally only by unit tests
    int _transectCount(void) const { return _transects.count(); }
 
    // Overrides from ComplexMissionItem
    int     lastSequenceNumber  (void) const final;
    QString mapVisualQML        (void) const override = 0;
    bool    load                (const QJsonObject& complexObject, int sequenceNumber, QString& errorString) override = 0;
    void    addKMLVisuals       (KMLPlanDomDocument& domDocument) final;
    double  complexDistance     (void) const final { return _complexDistance; }
    double  greatestDistanceTo  (const QGeoCoordinate &other) const final;
 
    // Overrides from VisualMissionItem
    void                save                        (QJsonArray&  planItems) override = 0;
    bool                specifiesCoordinate         (void) const override = 0;
    void                appendMissionItems          (QList<MissionItem*>& items, QObject* missionItemParent) final;
    void                applyNewAltitude            (double newAltitude) final;
    bool                dirty                       (void) const final { return _dirty; }
    bool                isSimpleItem                (void) const final { return false; }
    bool                isStandaloneCoordinate      (void) const final { return false; }
    bool                specifiesAltitudeOnly       (void) const final { return false; }
    QGeoCoordinate      coordinate                  (void) const final { return entryCoordinate(); }
    QGeoCoordinate      entryCoordinate             (void) const final { return _entryCoordinate; }
    QGeoCoordinate      exitCoordinate              (void) const final { return _exitCoordinate; }
    int                 sequenceNumber              (void) const final { return _sequenceNumber; }
    double              specifiedFlightSpeed        (void) final { return std::numeric_limits<double>::quiet_NaN(); }
    double              specifiedGimbalYaw          (void) final { return std::numeric_limits<double>::quiet_NaN(); }
    double              specifiedGimbalPitch        (void) final { return std::numeric_limits<double>::quiet_NaN(); }
    void                setMissionFlightStatus      (MissionFlightStatus_t& missionFlightStatus) final;
    ReadyForSaveState   readyForSaveState         (void) const override;
    QString             commandDescription          (void) const override { return tr("Transect"); }
    QString             commandName                 (void) const override { return tr("Transect"); }
    QString             abbreviation                (void) const override { return tr("T"); }
    bool                exitCoordinateSameAsEntry   (void) const final { return false; }
    void                setDirty                    (bool dirty) final;
    void                setCoordinate               (const QGeoCoordinate& coordinate) override;
    void                setSequenceNumber           (int sequenceNumber) final;
    double              editableAlt                 (void) const final;
    double              amslEntryAlt                (void) const final;
    double              amslExitAlt                 (void) const final;
    double              minAMSLAltitude             (void) const final;
    double              maxAMSLAltitude             (void) const final;
 
    static constexpr const char* turnAroundDistanceName                = "TurnAroundDistance";
    static constexpr const char* turnAroundDistanceMultiRotorName      = "TurnAroundDistanceMultiRotor";
    static constexpr const char* cameraTriggerInTurnAroundName         = "CameraTriggerInTurnAround";
    static constexpr const char* hoverAndCaptureName                   = "HoverAndCapture";
    static constexpr const char* refly90DegreesName                    = "Refly90Degrees";
    static constexpr const char* terrainAdjustToleranceName            = "TerrainAdjustTolerance";
    static constexpr const char* terrainAdjustMaxClimbRateName         = "TerrainAdjustMaxClimbRate";
    static constexpr const char* terrainAdjustMaxDescentRateName       = "TerrainAdjustMaxDescentRate";
 
signals:
    void cameraShotsChanged             (void);
    void timeBetweenShotsChanged        (void);
    void visualTransectPointsChanged    (void);
    void coveredAreaChanged             (void);
    void _updateFlightPathSegmentsSignal(void);
 
protected slots:
    void _setDirty                          (void);
    void _setIfDirty                        (bool dirty);
    void _updateCoordinateAltitudes         (void);
    void _polyPathTerrainData               (bool success, const QList<TerrainPathQuery::PathHeightInfo_t>& rgPathHeightInfo);
    void _missionItemCoordTerrainData       (bool success, QList<double> heights);
    void _rebuildTransects                  (void);
 
protected:
    virtual void _rebuildTransectsPhase1    (void) = 0; 
    virtual void _recalcCameraShots         (void) = 0;
 
    void    _save                           (QJsonObject& saveObject);
    bool    _load                           (const QJsonObject& complexObject, bool forPresets, QString& errorString);
    void    _setExitCoordinate              (const QGeoCoordinate& coordinate);
    void    _setCameraShots                 (int cameraShots);
    double  _triggerDistance                (void) const;
    bool    _hasTurnaround                  (void) const;
    double  _turnAroundDistance             (void) const;
    void    _appendWaypoint                 (QList<MissionItem*>& items, QObject* missionItemParent, int& seqNum, MAV_FRAME mavFrame, float holdTime, const QGeoCoordinate& coordinate);
    void    _appendSinglePhotoCapture       (QList<MissionItem*>& items, QObject* missionItemParent, int& seqNum);
    void    _appendConditionGate            (QList<MissionItem*>& items, QObject* missionItemParent, int& seqNum, MAV_FRAME mavFrame, const QGeoCoordinate& coordinate);
    void    _appendCameraTriggerDistance    (QList<MissionItem*>& items, QObject* missionItemParent, int& seqNum, float triggerDistance);
    void    _appendCameraTriggerDistanceUpdatePoint(QList<MissionItem*>& items, QObject* missionItemParent, int& seqNum, MAV_FRAME mavFrame, const QGeoCoordinate& coordinate, bool useConditionGate, float triggerDistance);
    void    _buildAndAppendMissionItems     (QList<MissionItem*>& items, QObject* missionItemParent);
    void    _appendLoadedMissionItems       (QList<MissionItem*>& items, QObject* missionItemParent);
    void    _recalcComplexDistance          (void);
 
    int                 _sequenceNumber = 0;
    QGeoCoordinate      _entryCoordinate;
    QGeoCoordinate      _exitCoordinate;
    QGCMapPolygon       _surveyAreaPolygon;
 
    enum CoordType {
        CoordTypeInterior,              
        CoordTypeInteriorHoverTrigger,  
        CoordTypeInteriorTerrainAdded,  
        CoordTypeSurveyEntry,           
        CoordTypeSurveyExit,            
        CoordTypeTurnaround,            
    };
 
    typedef struct {
        QGeoCoordinate  coord;
        CoordType       coordType;
    } CoordInfo_t;
 
    QVariantList                                _visualTransectPoints;                          
    QList<QList<CoordInfo_t>>                   _transects;
    QList<TerrainPathQuery::PathHeightInfo_t>   _rgPathHeightInfo;                              
    QList<QGeoCoordinate>                       _rgFlyThroughMissionItemCoords;
    QList<double>                               _rgFlyThroughMissionItemCoordsTerrainHeights;
    QList<CoordInfo_t>                          _rgFlightPathCoordInfo;                         
 
    bool            _ignoreRecalc =     false;
    double          _complexDistance =  qQNaN();
    int             _cameraShots =      0;
    double          _timeBetweenShots = 0;
    double          _vehicleSpeed =     5;
    CameraCalc      _cameraCalc;
    double          _minAMSLAltitude =  qQNaN();
    double          _maxAMSLAltitude =  qQNaN();
 
    QObject*            _loadedMissionItemsParent = nullptr;    
    QList<MissionItem*> _loadedMissionItems;                    
 
    QMap<QString, FactMetaData*> _metaDataMap;
 
    SettingsFact _turnAroundDistanceFact;
    SettingsFact _cameraTriggerInTurnAroundFact;
    SettingsFact _hoverAndCaptureFact;
    SettingsFact _refly90DegreesFact;
    SettingsFact _terrainAdjustToleranceFact;
    SettingsFact _terrainAdjustMaxClimbRateFact;
    SettingsFact _terrainAdjustMaxDescentRateFact;
 
    static constexpr const char* _jsonTransectStyleComplexItemKey      = "TransectStyleComplexItem";
    static constexpr const char* _jsonCameraCalcKey                    = "CameraCalc";
    static constexpr const char* _jsonVisualTransectPointsKey          = "VisualTransectPoints";
    static constexpr const char* _jsonItemsKey                         = "Items";
    static constexpr const char* _jsonTerrainFlightSpeed               = "TerrainFlightSpeed";
    static constexpr const char* _jsonCameraShotsKey                   = "CameraShots";
 
    static constexpr int _terrainQueryTimeoutMsecs=     1000;
    static constexpr int _hoverAndCaptureDelaySeconds = 4;
    static constexpr double _minimumTransectSpacingMeters = 0.3;
    static constexpr double _forceLargeTransectSpacingMeters = 100000;
 
private slots:
    void _reallyQueryTransectsPathHeightInfo        (void);
    void _handleHoverAndCaptureEnabled              (QVariant enabled);
    void _updateFlightPathSegmentsDontCallDirectly  (void);
    void _segmentTerrainCollisionChanged            (bool terrainCollision) final;
    void _distanceModeChanged                       (int distanceMode);
 
private:
    typedef struct {
        bool imagesInTurnaround;
        bool hasTurnarounds;
        bool addTriggerAtFirstAndLastPoint;
        bool useConditionGate;
    } BuildMissionItemsState_t;
 
    void    _queryTransectsPathHeightInfo                                   (void);
    void    _queryMissionItemCoordHeights                                   (void);
    void    _adjustForAvailableTerrainData                                  (void);
    void    _buildFlightPathCoordInfoFromTransects                          (void);
    void    _buildFlightPathCoordInfoFromPathHeightInfoForCalcAboveTerrain  (void);
    void    _buildFlightPathCoordInfoFromPathHeightInfoForTerrainFrame      (void);
    void    _buildFlightPathCoordInfoFromMissionItems                       (void);
    void    _adjustForMaxRates                                              (void);
    void    _adjustForTolerance                                             (void);
    double  _altitudeBetweenCoords                                          (const QGeoCoordinate& fromCoord, const QGeoCoordinate& toCoord, double percentTowardsTo);
    int     _maxPathHeight                                                  (const TerrainPathQuery::PathHeightInfo_t& pathHeightInfo, int fromIndex, int toIndex, double& maxHeight);
    BuildMissionItemsState_t _buildMissionItemsState                        (void) const;
 
    TerrainPolyPathQuery*       _currentTerrainPolyPathQuery        = nullptr;
    TerrainAtCoordinateQuery*   _currentTerrainAtCoordinateQuery    = nullptr;
    QTimer                      _terrainPolyPathQueryTimer;
 
    // Deprecated json keys
    static constexpr const char* _jsonTerrainFollowKeyDeprecated = "FollowTerrain";
};