MissionController.h 10.2 KB
Newer Older
1 2 3 4 5 6 7 8
/****************************************************************************
 *
 *   (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.
 *
 ****************************************************************************/
9 10 11 12 13


#ifndef MissionController_H
#define MissionController_H

14
#include "PlanElementController.h"
15 16
#include "QmlObjectListModel.h"
#include "Vehicle.h"
17
#include "QGCLoggingCategory.h"
18
#include "MavlinkQmlSingleton.h"
19

20 21
#include <QHash>

22
class CoordinateVector;
DonLakeFlyer's avatar
DonLakeFlyer committed
23
class VisualMissionItem;
24
class MissionItem;
25

26
Q_DECLARE_LOGGING_CATEGORY(MissionControllerLog)
27

28 29
typedef QPair<VisualMissionItem*,VisualMissionItem*> VisualItemPair;
typedef QHash<VisualItemPair, CoordinateVector*> CoordVectHashTable;
30
class MissionController : public PlanElementController
31 32
{
    Q_OBJECT
33

34 35 36 37
public:
    MissionController(QObject* parent = NULL);
    ~MissionController();

DonLakeFlyer's avatar
DonLakeFlyer committed
38 39 40 41 42 43 44 45 46 47 48 49 50 51
    typedef struct {
        double maxTelemetryDistance;
        double totalDistance;
        double totalTime;
        double hoverDistance;
        double hoverTime;
        double cruiseDistance;
        double cruiseTime;
        double cruiseSpeed;
        double hoverSpeed;
        double vehicleSpeed;    //</ Either cruise or hover speed based on vehicle type and vtol state
        double gimbalYaw;       ///< NaN signals yaw was never changed
    } MissionFlightStatus_t;

52
    // Mission settings
53 54 55 56 57 58 59 60 61 62 63 64
    Q_PROPERTY(QGeoCoordinate       plannedHomePosition     READ plannedHomePosition        NOTIFY plannedHomePositionChanged)
    Q_PROPERTY(QmlObjectListModel*  visualItems             READ visualItems                NOTIFY visualItemsChanged)
    Q_PROPERTY(QmlObjectListModel*  waypointLines           READ waypointLines              NOTIFY waypointLinesChanged)
    Q_PROPERTY(QStringList          complexMissionItemNames READ complexMissionItemNames    NOTIFY complexMissionItemNamesChanged)

    Q_PROPERTY(double               missionDistance         READ missionDistance            NOTIFY missionDistanceChanged)
    Q_PROPERTY(double               missionTime             READ missionTime                NOTIFY missionTimeChanged)
    Q_PROPERTY(double               missionHoverDistance    READ missionHoverDistance       NOTIFY missionHoverDistanceChanged)
    Q_PROPERTY(double               missionCruiseDistance   READ missionCruiseDistance      NOTIFY missionCruiseDistanceChanged)
    Q_PROPERTY(double               missionHoverTime        READ missionHoverTime           NOTIFY missionHoverTimeChanged)
    Q_PROPERTY(double               missionCruiseTime       READ missionCruiseTime          NOTIFY missionCruiseTimeChanged)
    Q_PROPERTY(double               missionMaxTelemetry     READ missionMaxTelemetry        NOTIFY missionMaxTelemetryChanged)
65

66
    Q_INVOKABLE void removeMissionItem(int index);
67

68 69 70
    /// Add a new simple mission item to the list
    ///     @param i: index to insert at
    /// @return Sequence number for new item
71 72
    Q_INVOKABLE int insertSimpleMissionItem(QGeoCoordinate coordinate, int i);

73
    /// Add a new complex mission item to the list
74 75
    ///     @param itemName: Name of complex item to create (from complexMissionItemNames)
    ///     @param mapCenterCoordinate: coordinate for current center of map
76 77
    ///     @param i: index to insert at
    /// @return Sequence number for new item
78
    Q_INVOKABLE int insertComplexMissionItem(QString itemName, QGeoCoordinate mapCenterCoordinate, int i);
79

Don Gagne's avatar
Don Gagne committed
80 81 82 83 84
    /// Loads the mission items from the specified file
    ///     @param[in] vehicle Vehicle we are loading items for
    ///     @param[in] filename File to load from
    ///     @param[out] visualItems Visual items loaded, returns NULL if error
    /// @return success/fail
85
    static bool loadItemsFromFile(Vehicle* vehicle, const QString& filename, QmlObjectListModel** visualItems);
Don Gagne's avatar
Don Gagne committed
86 87 88 89

    /// Sends the mission items to the specified vehicle
    static void sendItemsToVehicle(Vehicle* vehicle, QmlObjectListModel* visualMissionItems);

90
    // Overrides from PlanElementController
91 92 93 94 95 96 97 98 99
    void start                      (bool editMode) final;
    void startStaticActiveVehicle   (Vehicle* vehicle) final;
    void loadFromVehicle            (void) final;
    void sendToVehicle              (void) final;
    void loadFromFilePicker         (void) final;
    void loadFromFile               (const QString& filename) final;
    void saveToFilePicker           (void) final;
    void saveToFile                 (const QString& filename) final;
    void removeAll                  (void) final;
100
    void removeAllFromVehicle       (void) final;
101 102 103
    bool syncInProgress             (void) const final;
    bool dirty                      (void) const final;
    void setDirty                   (bool dirty) final;
104
    bool containsItems              (void) const final;
105

106 107
    QString fileExtension(void) const final;

108 109
    // Property accessors

110 111 112 113
    QGeoCoordinate      plannedHomePosition     (void);
    QmlObjectListModel* visualItems             (void) { return _visualItems; }
    QmlObjectListModel* waypointLines           (void) { return &_waypointLines; }
    QStringList         complexMissionItemNames (void) const;
114

DonLakeFlyer's avatar
DonLakeFlyer committed
115 116 117 118 119 120 121
    double  missionDistance         (void) const { return _missionFlightStatus.totalDistance; }
    double  missionTime             (void) const { return _missionFlightStatus.totalTime; }
    double  missionHoverDistance    (void) const { return _missionFlightStatus.hoverDistance; }
    double  missionHoverTime        (void) const { return _missionFlightStatus.hoverTime; }
    double  missionCruiseDistance   (void) const { return _missionFlightStatus.cruiseDistance; }
    double  missionCruiseTime       (void) const { return _missionFlightStatus.cruiseTime; }
    double  missionMaxTelemetry     (void) const { return _missionFlightStatus.maxTelemetryDistance; }
122

123
signals:
124
    void plannedHomePositionChanged(QGeoCoordinate plannedHomePosition);
125
    void visualItemsChanged(void);
126
    void waypointLinesChanged(void);
127
    void newItemsFromVehicle(void);
128
    void missionDistanceChanged(double missionDistance);
129 130 131 132 133
    void missionTimeChanged(void);
    void missionHoverDistanceChanged(double missionHoverDistance);
    void missionHoverTimeChanged(void);
    void missionCruiseDistanceChanged(double missionCruiseDistance);
    void missionCruiseTimeChanged(void);
134
    void missionMaxTelemetryChanged(double missionMaxTelemetry);
135
    void complexMissionItemNamesChanged(void);
136

137
private slots:
138
    void _newMissionItemsAvailableFromVehicle(bool removeAllRequested);
139
    void _itemCommandChanged(void);
140 141 142
    void _activeVehicleHomePositionAvailableChanged(bool homePositionAvailable);
    void _activeVehicleHomePositionChanged(const QGeoCoordinate& homePosition);
    void _inProgressChanged(bool inProgress);
143
    void _currentMissionItemChanged(int sequenceNumber);
144
    void _recalcWaypointLines(void);
DonLakeFlyer's avatar
DonLakeFlyer committed
145
    void _recalcMissionFlightStatus(void);
146
    void _homeCoordinateChanged(void);
147
    void _updateContainsItems(void);
148 149

private:
150
    void _init(void);
151
    void _recalcSequence(void);
152 153
    void _recalcChildItems(void);
    void _recalcAll(void);
154 155 156 157
    void _initAllVisualItems(void);
    void _deinitAllVisualItems(void);
    void _initVisualItem(VisualMissionItem* item);
    void _deinitVisualItem(VisualMissionItem* item);
Don Gagne's avatar
Don Gagne committed
158
    void _setupActiveVehicle(Vehicle* activeVehicle, bool forceLoadFromVehicle);
159
    static void _calcPrevWaypointValues(double homeAlt, VisualMissionItem* currentItem, VisualMissionItem* prevItem, double* azimuth, double* distance, double* altDifference);
160
    static double _calcDistanceToHome(VisualMissionItem* currentItem, VisualMissionItem* homeItem);
161
    bool _findPreviousAltitude(int newIndex, double* prevAltitude, MAV_FRAME* prevFrame);
Don Gagne's avatar
Don Gagne committed
162 163
    static double _normalizeLat(double lat);
    static double _normalizeLon(double lon);
164 165 166 167
    static void _addMissionSettings(Vehicle* vehicle, QmlObjectListModel* visualItems, bool addToCenter);
    static bool _loadJsonMissionFile(Vehicle* vehicle, const QByteArray& bytes, QmlObjectListModel* visualItems, QString& errorString);
    static bool _loadJsonMissionFileV1(Vehicle* vehicle, const QJsonObject& json, QmlObjectListModel* visualItems, QString& errorString);
    static bool _loadJsonMissionFileV2(Vehicle* vehicle, const QJsonObject& json, QmlObjectListModel* visualItems, QString& errorString);
Don Gagne's avatar
Don Gagne committed
168
    static bool _loadTextMissionFile(Vehicle* vehicle, QTextStream& stream, QmlObjectListModel* visualItems, QString& errorString);
169
    int _nextSequenceNumber(void);
170 171 172 173 174 175 176
    void _setMissionDistance(double missionDistance);
    void _setMissionTime(double missionTime);
    void _setMissionHoverDistance(double missionHoverDistance);
    void _setMissionHoverTime(double missionHoverTime);
    void _setMissionCruiseDistance(double missionCruiseDistance);
    void _setMissionCruiseTime(double missionCruiseTime);
    void _setMissionMaxTelemetry(double missionMaxTelemetry);
177
    static void _scanForAdditionalSettings(QmlObjectListModel* visualItems, Vehicle* vehicle);
178
    static bool _convertToMissionItems(QmlObjectListModel* visualMissionItems, QList<MissionItem*>& rgMissionItems, QObject* missionItemParent);
179

180
    // Overrides from PlanElementController
181
    void _activeVehicleBeingRemoved(void) final;
182 183
    void _activeVehicleSet(void) final;

184
private:
DonLakeFlyer's avatar
DonLakeFlyer committed
185 186 187 188 189 190 191 192 193
    QmlObjectListModel*     _visualItems;
    QmlObjectListModel      _waypointLines;
    CoordVectHashTable      _linesTable;
    bool                    _firstItemsFromVehicle;
    bool                    _missionItemsRequested;
    bool                    _queuedSend;
    MissionFlightStatus_t   _missionFlightStatus;
    QString                 _surveyMissionItemName;
    QString                 _fwLandingMissionItemName;
194

195
    static const char*  _settingsGroup;
196 197

    // Json file keys for persistence
Don Gagne's avatar
Don Gagne committed
198 199
    static const char*  _jsonFileTypeValue;
    static const char*  _jsonFirmwareTypeKey;
200 201 202
    static const char*  _jsonVehicleTypeKey;
    static const char*  _jsonCruiseSpeedKey;
    static const char*  _jsonHoverSpeedKey;
Don Gagne's avatar
Don Gagne committed
203 204 205 206 207
    static const char*  _jsonItemsKey;
    static const char*  _jsonPlannedHomePositionKey;
    static const char*  _jsonParamsKey;

    // Deprecated V1 format keys
208
    static const char*  _jsonMavAutopilotKey;
209
    static const char*  _jsonComplexItemsKey;
Don Gagne's avatar
Don Gagne committed
210 211

    static const int    _missionFileVersion;
212 213 214
};

#endif