MissionManager.h 4.99 KB
Newer Older
Don Gagne's avatar
Don Gagne committed
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40
/*=====================================================================
 
 QGroundControl Open Source Ground Control Station
 
 (c) 2009 - 2014 QGROUNDCONTROL PROJECT <http://www.qgroundcontrol.org>
 
 This file is part of the QGROUNDCONTROL project
 
 QGROUNDCONTROL is free software: you can redistribute it and/or modify
 it under the terms of the GNU General Public License as published by
 the Free Software Foundation, either version 3 of the License, or
 (at your option) any later version.
 
 QGROUNDCONTROL is distributed in the hope that it will be useful,
 but WITHOUT ANY WARRANTY; without even the implied warranty of
 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 GNU General Public License for more details.
 
 You should have received a copy of the GNU General Public License
 along with QGROUNDCONTROL. If not, see <http://www.gnu.org/licenses/>.
 
 ======================================================================*/

#ifndef MissionManager_H
#define MissionManager_H

#include <QObject>
#include <QLoggingCategory>
#include <QThread>
#include <QMutex>
#include <QTimer>

#include "QmlObjectListModel.h"
#include "QGCMAVLink.h"
#include "QGCLoggingCategory.h"

class Vehicle;

Q_DECLARE_LOGGING_CATEGORY(MissionManagerLog)

41
class MissionManager : public QObject
Don Gagne's avatar
Don Gagne committed
42 43 44 45 46 47 48 49
{
    Q_OBJECT
    
public:
    /// @param uas Uas which this set of facts is associated with
    MissionManager(Vehicle* vehicle);
    ~MissionManager();
    
Don Gagne's avatar
Don Gagne committed
50
    Q_PROPERTY(bool                 inProgress      READ inProgress     NOTIFY inProgressChanged)
Don Gagne's avatar
Don Gagne committed
51 52
    Q_PROPERTY(QmlObjectListModel*  missionItems    READ missionItems   CONSTANT)
    Q_PROPERTY(bool                 canEdit         READ canEdit        NOTIFY  canEditChanged)
Don Gagne's avatar
Don Gagne committed
53 54 55 56 57
    
    // Property accessors
    
    bool inProgress(void) { return _retryAck != AckNone; }
    QmlObjectListModel* missionItems(void) { return &_missionItems; }
Don Gagne's avatar
Don Gagne committed
58 59 60
    bool canEdit(void) { return _canEdit; }
    
    // C++ methods
Don Gagne's avatar
Don Gagne committed
61 62 63 64
    
    void requestMissionItems(void);
    
    /// Writes the specified set of mission items to the vehicle
Don Gagne's avatar
Don Gagne committed
65 66 67
    ///     @oaram missionItems Items to send to vehicle
    ///     @param skipFirstItem true: Don't send first item
    void writeMissionItems(const QmlObjectListModel& missionItems, bool skipFirstItem);
Don Gagne's avatar
Don Gagne committed
68 69 70 71
    
    /// Returns a copy of the current set of mission items. Caller is responsible for
    /// freeing returned object.
    QmlObjectListModel* copyMissionItems(void);
72 73 74 75 76 77 78 79 80 81 82
    
    /// Error codes returned in error signal
    typedef enum {
        InternalError,
        AckTimeoutError,        ///< Timed out waiting for response from vehicle
        ProtocolOrderError,     ///< Incorrect protocol sequence from vehicle
        RequestRangeError,      ///< Vehicle requested item out of range
        ItemMismatchError,      ///< Vehicle returned item with seq # different than requested
        VehicleError,           ///< Vehicle returned error
        MissingRequestsError,   ///< Vehicle did not request all items during write sequence
    } ErrorCode_t;
Don Gagne's avatar
Don Gagne committed
83

Don Gagne's avatar
Don Gagne committed
84 85 86 87
    // These values are public so the unit test can set appropriate signal wait times
    static const int _ackTimeoutMilliseconds= 2000;
    static const int _maxRetryCount = 5;
    
Don Gagne's avatar
Don Gagne committed
88
signals:
Don Gagne's avatar
Don Gagne committed
89 90
    // Public signals
    void canEditChanged(bool canEdit);
Don Gagne's avatar
Don Gagne committed
91
    void newMissionItemsAvailable(void);
Don Gagne's avatar
Don Gagne committed
92
    void inProgressChanged(bool inProgress);
93
    void error(int errorCode, const QString& errorMsg);
Don Gagne's avatar
Don Gagne committed
94
    
Don Gagne's avatar
Don Gagne committed
95 96 97 98 99 100 101 102 103 104 105 106
private slots:
    void _mavlinkMessageReceived(const mavlink_message_t& message);
    void _ackTimeout(void);
    
private:
    typedef enum {
        AckNone,            ///< State machine is idle
        AckMissionCount,    ///< MISSION_COUNT message expected
        AckMissionItem,     ///< MISSION_ITEM expected
        AckMissionRequest,  ///< MISSION_REQUEST is expected, or MISSION_ACK to end sequence
    } AckType_t;
    
107
    void _startAckTimeout(AckType_t ack);
Don Gagne's avatar
Don Gagne committed
108 109 110 111 112 113 114 115
    bool _stopAckTimeout(AckType_t expectedAck);
    void _sendTransactionComplete(void);
    void _handleMissionCount(const mavlink_message_t& message);
    void _handleMissionItem(const mavlink_message_t& message);
    void _handleMissionRequest(const mavlink_message_t& message);
    void _handleMissionAck(const mavlink_message_t& message);
    void _requestNextMissionItem(int sequenceNumber);
    void _clearMissionItems(void);
116 117 118 119
    void _sendError(ErrorCode_t errorCode, const QString& errorMsg);
    void _retryWrite(void);
    void _retryRead(void);
    bool _retrySequence(AckType_t ackType);
Don Gagne's avatar
Don Gagne committed
120
    QString _ackTypeToString(AckType_t ackType);
Don Gagne's avatar
Don Gagne committed
121
    QString _missionResultToString(MAV_MISSION_RESULT result);
Don Gagne's avatar
Don Gagne committed
122 123 124 125 126

private:
    Vehicle*            _vehicle;
    
    int                 _cMissionItems;     ///< Mission items on vehicle
Don Gagne's avatar
Don Gagne committed
127
    bool                _canEdit;           ///< true: Mission items are editable in the ui
Don Gagne's avatar
Don Gagne committed
128 129 130 131 132 133 134 135 136 137 138 139 140

    QTimer*             _ackTimeoutTimer;
    AckType_t           _retryAck;
    int                 _retryCount;
    
    int                 _expectedSequenceNumber;
    
    QMutex _dataMutex;
    
    QmlObjectListModel  _missionItems;
};

#endif