MAVLinkProtocol.h 6.83 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.
 *
 ****************************************************************************/
pixhawk's avatar
pixhawk committed
9
10
11
12
13
14
15
16

#ifndef MAVLINKPROTOCOL_H_
#define MAVLINKPROTOCOL_H_

#include <QObject>
#include <QMutex>
#include <QString>
#include <QTimer>
lm's avatar
lm committed
17
#include <QFile>
lm's avatar
lm committed
18
#include <QMap>
pixhawk's avatar
pixhawk committed
19
#include <QByteArray>
20
#include <QLoggingCategory>
Don Gagne's avatar
Don Gagne committed
21

pixhawk's avatar
pixhawk committed
22
#include "LinkInterface.h"
pixhawk's avatar
pixhawk committed
23
#include "QGCMAVLink.h"
24
#include "QGC.h"
Don Gagne's avatar
Don Gagne committed
25
#include "QGCTemporaryFile.h"
26
#include "QGCToolbox.h"
pixhawk's avatar
pixhawk committed
27

28
class LinkManager;
29
30
class MultiVehicleManager;
class QGCApplication;
31

32
33
Q_DECLARE_LOGGING_CATEGORY(MAVLinkProtocolLog)

pixhawk's avatar
pixhawk committed
34
/**
pixhawk's avatar
pixhawk committed
35
 * @brief MAVLink micro air vehicle protocol reference implementation.
pixhawk's avatar
pixhawk committed
36
 *
pixhawk's avatar
pixhawk committed
37
38
39
 * MAVLink is a generic communication protocol for micro air vehicles.
 * for more information, please see the official website.
 * @ref http://pixhawk.ethz.ch/software/mavlink/
pixhawk's avatar
pixhawk committed
40
 **/
41
class MAVLinkProtocol : public QGCTool
42
{
pixhawk's avatar
pixhawk committed
43
44
    Q_OBJECT

45
public:
46
47
48
    MAVLinkProtocol(QGCApplication* app);
    ~MAVLinkProtocol();

pixhawk's avatar
pixhawk committed
49
50
    /** @brief Get the human-friendly name of this protocol */
    QString getName();
51
52
53
54
    /** @brief Get the system id of this application */
    int getSystemId();
    /** @brief Get the component id of this application */
    int getComponentId();
Don Gagne's avatar
Don Gagne committed
55
    
lm's avatar
lm committed
56
    /** @brief Get protocol version check state */
57
58
59
    bool versionCheckEnabled() const {
        return m_enable_version_check;
    }
60
    /** @brief Get the protocol version */
61
62
63
    int getVersion() {
        return MAVLINK_VERSION;
    }
64
65
66
67
    /**
     * Retrieve a total of all successfully parsed packets for the specified link.
     * @returns -1 if this is not available for this protocol, # of packets otherwise.
     */
68
    qint32 getReceivedPacketCount(const LinkInterface *link) const {
69
        return totalReceiveCounter[link->mavlinkChannel()];
70
71
72
73
74
    }
    /**
     * Retrieve a total of all parsing errors for the specified link.
     * @returns -1 if this is not available for this protocol, # of errors otherwise.
     */
75
    qint32 getParsingErrorCount(const LinkInterface *link) const {
76
        return totalErrorCounter[link->mavlinkChannel()];
77
78
79
80
81
    }
    /**
     * Retrieve a total of all dropped packets for the specified link.
     * @returns -1 if this is not available for this protocol, # of packets otherwise.
     */
82
    qint32 getDroppedPacketCount(const LinkInterface *link) const {
83
        return totalLossCounter[link->mavlinkChannel()];
84
    }
85
86
87
88
    /**
     * Reset the counters for all metadata for this link.
     */
    virtual void resetMetadataForLink(const LinkInterface *link);
Don Gagne's avatar
Don Gagne committed
89
    
90
91
    /// Suspend/Restart logging during replay.
    void suspendLogForReplay(bool suspend);
Lorenz Meier's avatar
Lorenz Meier committed
92

93
94
95
    // Override from QGCTool
    virtual void setToolbox(QGCToolbox *toolbox);

pixhawk's avatar
pixhawk committed
96
97
public slots:
    /** @brief Receive bytes from a communication interface */
98
    void receiveBytes(LinkInterface* link, QByteArray b);
99
    
100
101
    /** @brief Set the system id of this application */
    void setSystemId(int id);
pixhawk's avatar
pixhawk committed
102

lm's avatar
lm committed
103
104
105
    /** @brief Enable / disable version check */
    void enableVersionCheck(bool enabled);

106
107
108
109
    /** @brief Load protocol settings */
    void loadSettings();
    /** @brief Store protocol settings */
    void storeSettings();
Don Gagne's avatar
Don Gagne committed
110
    
Don Gagne's avatar
Don Gagne committed
111
#ifndef __mobile__
Don Gagne's avatar
Don Gagne committed
112
113
    /// @brief Deletes any log files which are in the temp directory
    static void deleteTempLogFiles(void);
114
115
116
    
    /// Checks for lost log files
    void checkForLostLogFiles(void);
Don Gagne's avatar
Don Gagne committed
117
#endif
Don Gagne's avatar
Don Gagne committed
118

119
protected:
lm's avatar
lm committed
120
    bool m_enable_version_check; ///< Enable checking of version match of MAV and QGC
121
122
123
124
125
126
127
    QMutex receiveMutex;        ///< Mutex to protect receiveBytes function
    int lastIndex[256][256];    ///< Store the last received sequence ID for each system/componenet pair
    int totalReceiveCounter[MAVLINK_COMM_NUM_BUFFERS];    ///< The total number of successfully received messages
    int totalLossCounter[MAVLINK_COMM_NUM_BUFFERS];       ///< Total messages lost during transmission.
    int totalErrorCounter[MAVLINK_COMM_NUM_BUFFERS];      ///< Total count of all parsing errors. Generally <= totalLossCounter.
    int currReceiveCounter[MAVLINK_COMM_NUM_BUFFERS];     ///< Received messages during this sample time window. Used for calculating loss %.
    int currLossCounter[MAVLINK_COMM_NUM_BUFFERS];        ///< Lost messages during this sample time window. Used for calculating loss %.
128
    bool versionMismatchIgnore;
129
    int systemId;
130

pixhawk's avatar
pixhawk committed
131
signals:
Don Gagne's avatar
Don Gagne committed
132
    /// Heartbeat received on link
133
    void vehicleHeartbeatInfo(LinkInterface* link, int vehicleId, int componentId, int vehicleMavlinkVersion, int vehicleFirmwareType, int vehicleType);
Don Gagne's avatar
Don Gagne committed
134

pixhawk's avatar
pixhawk committed
135
136
    /** @brief Message received and directly copied via signal */
    void messageReceived(LinkInterface* link, mavlink_message_t message);
lm's avatar
lm committed
137
138
    /** @brief Emitted if version check is enabled / disabled */
    void versionCheckChanged(bool enabled);
139
140
    /** @brief Emitted if a message from the protocol should reach the user */
    void protocolStatusMessage(const QString& title, const QString& message);
141
142
    /** @brief Emitted if a new system ID was set */
    void systemIdChanged(int systemId);
143
144
145

    void receiveLossPercentChanged(int uasId, float lossPercent);
    void receiveLossTotalChanged(int uasId, int totalLoss);
146

147
148
149
150
151
    /**
     * @brief Emitted if a new radio status packet received
     *
     * @param rxerrors receive errors
     * @param fixed count of error corrected packets
152
153
     * @param rssi local signal strength in dBm
     * @param remrssi remote signal strength in dBm
154
155
156
157
     * @param txbuf how full the tx buffer is as a percentage
     * @param noise background noise level
     * @param remnoise remote background noise level
     */
158
    void radioStatusChanged(LinkInterface* link, unsigned rxerrors, unsigned fixed, int rssi, int remrssi,
159
    unsigned txbuf, unsigned noise, unsigned remnoise);
Don Gagne's avatar
Don Gagne committed
160
    
161
162
163
164
165
    /// Emitted when a temporary telemetry log file is ready for saving
    void saveTelemetryLog(QString tempLogfile);

    /// Emitted when a telemetry log is started to save.
    void checkTelemetrySavePath(void);
Don Gagne's avatar
Don Gagne committed
166
167
168

private slots:
    void _vehicleCountChanged(int count);
Don Gagne's avatar
Don Gagne committed
169
170
    
private:
Don Gagne's avatar
Don Gagne committed
171
#ifndef __mobile__
Don Gagne's avatar
Don Gagne committed
172
173
174
    bool _closeLogFile(void);
    void _startLogging(void);
    void _stopLogging(void);
Don Gagne's avatar
Don Gagne committed
175

Don Gagne's avatar
Don Gagne committed
176
177
    bool _logSuspendError;      ///< true: Logging suspended due to error
    bool _logSuspendReplay;     ///< true: Logging suspended due to replay
178
    bool _vehicleWasArmed;      ///< true: Vehicle was armed during log sequence
Don Gagne's avatar
Don Gagne committed
179

Don Gagne's avatar
Don Gagne committed
180
181
182
    QGCTemporaryFile    _tempLogFile;            ///< File to log to
    static const char*  _tempLogFileTemplate;    ///< Template for temporary log file
    static const char*  _logFileExtension;       ///< Extension for log files
Don Gagne's avatar
Don Gagne committed
183
#endif
Don Gagne's avatar
Don Gagne committed
184

185
186
    LinkManager*            _linkMgr;
    MultiVehicleManager*    _multiVehicleManager;
pixhawk's avatar
pixhawk committed
187
188
189
};

#endif // MAVLINKPROTOCOL_H_