MAVLinkProtocol.h 8.23 KB
Newer Older
pixhawk's avatar
pixhawk committed
1 2
/*=====================================================================

pixhawk's avatar
pixhawk committed
3
QGroundControl Open Source Ground Control Station
pixhawk's avatar
pixhawk committed
4

pixhawk's avatar
pixhawk committed
5
(c) 2009, 2010 QGROUNDCONTROL PROJECT <http://www.qgroundcontrol.org>
pixhawk's avatar
pixhawk committed
6

pixhawk's avatar
pixhawk committed
7
This file is part of the QGROUNDCONTROL project
pixhawk's avatar
pixhawk committed
8

pixhawk's avatar
pixhawk committed
9
    QGROUNDCONTROL is free software: you can redistribute it and/or modify
pixhawk's avatar
pixhawk committed
10 11 12 13
    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.

pixhawk's avatar
pixhawk committed
14
    QGROUNDCONTROL is distributed in the hope that it will be useful,
pixhawk's avatar
pixhawk committed
15 16 17 18 19
    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
pixhawk's avatar
pixhawk committed
20
    along with QGROUNDCONTROL. If not, see <http://www.gnu.org/licenses/>.
pixhawk's avatar
pixhawk committed
21 22 23 24 25

======================================================================*/

/**
 * @file
pixhawk's avatar
pixhawk committed
26 27
 *   @brief Definition of class MAVLinkProtocol
 *   @author Lorenz Meier <mail@qgroundcontrol.org>
pixhawk's avatar
pixhawk committed
28 29 30 31 32 33 34 35 36
 */

#ifndef MAVLINKPROTOCOL_H_
#define MAVLINKPROTOCOL_H_

#include <QObject>
#include <QMutex>
#include <QString>
#include <QTimer>
lm's avatar
lm committed
37
#include <QFile>
lm's avatar
lm committed
38
#include <QMap>
pixhawk's avatar
pixhawk committed
39 40 41
#include <QByteArray>
#include "ProtocolInterface.h"
#include "LinkInterface.h"
pixhawk's avatar
pixhawk committed
42
#include "QGCMAVLink.h"
43
#include "QGC.h"
pixhawk's avatar
pixhawk committed
44 45

/**
pixhawk's avatar
pixhawk committed
46
 * @brief MAVLink micro air vehicle protocol reference implementation.
pixhawk's avatar
pixhawk committed
47
 *
pixhawk's avatar
pixhawk committed
48 49 50
 * 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
51
 **/
52 53
class MAVLinkProtocol : public ProtocolInterface
{
pixhawk's avatar
pixhawk committed
54 55 56 57 58 59 60 61
    Q_OBJECT

public:
    MAVLinkProtocol();
    ~MAVLinkProtocol();

    /** @brief Get the human-friendly name of this protocol */
    QString getName();
62 63 64 65
    /** @brief Get the system id of this application */
    int getSystemId();
    /** @brief Get the component id of this application */
    int getComponentId();
pixhawk's avatar
pixhawk committed
66 67 68
    /** @brief The auto heartbeat emission rate in Hertz */
    int getHeartbeatRate();
    /** @brief Get heartbeat state */
69 70 71
    bool heartbeatsEnabled() const {
        return m_heartbeatsEnabled;
    }
lm's avatar
lm committed
72
    /** @brief Get logging state */
73 74 75
    bool loggingEnabled() const {
        return m_loggingEnabled;
    }
lm's avatar
lm committed
76
    /** @brief Get protocol version check state */
77 78 79
    bool versionCheckEnabled() const {
        return m_enable_version_check;
    }
80
    /** @brief Get the multiplexing state */
81 82 83
    bool multiplexingEnabled() const {
        return m_multiplexingEnabled;
    }
84
    /** @brief Get the authentication state */
85 86 87
    bool getAuthEnabled() {
        return m_authEnabled;
    }
88
    /** @brief Get the protocol version */
89 90 91
    int getVersion() {
        return MAVLINK_VERSION;
    }
92
    /** @brief Get the auth key */
93 94 95
    QString getAuthKey() {
        return m_authKey;
    }
pixhawk's avatar
pixhawk committed
96
    /** @brief Get the name of the packet log file */
97
    QString getLogfileName();
98
    /** @brief Get state of parameter retransmission */
99 100 101
    bool paramGuardEnabled() {
        return m_paramGuardEnabled;
    }
102
    /** @brief Get parameter read timeout */
103 104 105
    int getParamRetransmissionTimeout() {
        return m_paramRetransmissionTimeout;
    }
106
    /** @brief Get parameter write timeout */
107 108 109
    int getParamRewriteTimeout() {
        return m_paramRewriteTimeout;
    }
110
    /** @brief Get state of action retransmission */
111 112 113
    bool actionGuardEnabled() {
        return m_actionGuardEnabled;
    }
114
    /** @brief Get parameter read timeout */
115 116 117
    int getActionRetransmissionTimeout() {
        return m_actionRetransmissionTimeout;
    }
pixhawk's avatar
pixhawk committed
118 119 120

public slots:
    /** @brief Receive bytes from a communication interface */
121
    void receiveBytes(LinkInterface* link, QByteArray b);
pixhawk's avatar
pixhawk committed
122 123 124 125 126 127
    /** @brief Send MAVLink message through serial interface */
    void sendMessage(mavlink_message_t message);
    /** @brief Send MAVLink message through serial interface */
    void sendMessage(LinkInterface* link, mavlink_message_t message);
    /** @brief Set the rate at which heartbeats are emitted */
    void setHeartbeatRate(int rate);
128 129
    /** @brief Set the system id of this application */
    void setSystemId(int id);
pixhawk's avatar
pixhawk committed
130 131 132 133

    /** @brief Enable / disable the heartbeat emission */
    void enableHeartbeats(bool enabled);

lm's avatar
lm committed
134 135 136
    /** @brief Enable/disable binary packet logging */
    void enableLogging(bool enabled);

137 138 139
    /** @brief Enabled/disable packet multiplexing */
    void enableMultiplexing(bool enabled);

140 141 142
    /** @brief Enable / disable parameter retransmission */
    void enableParamGuard(bool enabled);

143 144 145
    /** @brief Enable / disable action retransmission */
    void enableActionGuard(bool enabled);

146 147 148 149 150 151
    /** @brief Set parameter read timeout */
    void setParamRetransmissionTimeout(int ms);

    /** @brief Set parameter write timeout */
    void setParamRewriteTimeout(int ms);

152 153 154
    /** @brief Set parameter read timeout */
    void setActionRetransmissionTimeout(int ms);

155 156 157
    /** @brief Set log file name */
    void setLogfileName(const QString& filename);

lm's avatar
lm committed
158 159 160
    /** @brief Enable / disable version check */
    void enableVersionCheck(bool enabled);

161 162 163 164
    /** @brief Enable / disable authentication */
    void enableAuth(bool enable);

    /** @brief Set authentication token */
165 166 167
    void setAuthKey(QString key) {
        m_authKey = key;
    }
168

pixhawk's avatar
pixhawk committed
169 170 171
    /** @brief Send an extra heartbeat to all connected units */
    void sendHeartbeat();

172 173 174 175 176
    /** @brief Load protocol settings */
    void loadSettings();
    /** @brief Store protocol settings */
    void storeSettings();

pixhawk's avatar
pixhawk committed
177
protected:
lm's avatar
lm committed
178 179
    QTimer* heartbeatTimer;    ///< Timer to emit heartbeats
    int heartbeatRate;         ///< Heartbeat rate, controls the timer interval
pixhawk's avatar
pixhawk committed
180
    bool m_heartbeatsEnabled;  ///< Enabled/disable heartbeat emission
181
    bool m_multiplexingEnabled; ///< Enable/disable packet multiplexing
182 183 184
    bool m_authEnabled;        ///< Enable authentication token broadcast
    QString m_authKey;         ///< Authentication key
    bool m_loggingEnabled;     ///< Enable/disable packet logging
lm's avatar
lm committed
185
    QFile* m_logfile;           ///< Logfile
lm's avatar
lm committed
186
    bool m_enable_version_check; ///< Enable checking of version match of MAV and QGC
187 188
    int m_paramRetransmissionTimeout; ///< Timeout for parameter retransmission
    int m_paramRewriteTimeout;    ///< Timeout for sending re-write request
189 190 191
    bool m_paramGuardEnabled;       ///< Parameter retransmission/rewrite enabled
    bool m_actionGuardEnabled;       ///< Action request retransmission enabled
    int m_actionRetransmissionTimeout; ///< Timeout for parameter retransmission
lm's avatar
lm committed
192
    QMutex receiveMutex;       ///< Mutex to protect receiveBytes function
lm's avatar
lm committed
193
    int lastIndex[256][256];
lm's avatar
lm committed
194 195
    int totalReceiveCounter;
    int totalLossCounter;
196 197
    int currReceiveCounter;
    int currLossCounter;
198
    bool versionMismatchIgnore;
199
    int systemId;
pixhawk's avatar
pixhawk committed
200 201 202 203 204 205

signals:
    /** @brief Message received and directly copied via signal */
    void messageReceived(LinkInterface* link, mavlink_message_t message);
    /** @brief Emitted if heartbeat emission mode is changed */
    void heartbeatChanged(bool heartbeats);
lm's avatar
lm committed
206 207
    /** @brief Emitted if logging is started / stopped */
    void loggingChanged(bool enabled);
208 209
    /** @brief Emitted if multiplexing is started / stopped */
    void multiplexingChanged(bool enabled);
210 211 212 213
    /** @brief Emitted if authentication support is enabled / disabled */
    void authKeyChanged(QString key);
    /** @brief Authentication changed */
    void authChanged(bool enabled);
lm's avatar
lm committed
214 215
    /** @brief Emitted if version check is enabled / disabled */
    void versionCheckChanged(bool enabled);
216 217
    /** @brief Emitted if a message from the protocol should reach the user */
    void protocolStatusMessage(const QString& title, const QString& message);
218 219 220 221 222 223 224 225
    /** @brief Emitted if a new system ID was set */
    void systemIdChanged(int systemId);
    /** @brief Emitted if param guard status changed */
    void paramGuardChanged(bool enabled);
    /** @brief Emitted if param read timeout changed */
    void paramRetransmissionTimeoutChanged(int ms);
    /** @brief Emitted if param write timeout changed */
    void paramRewriteTimeoutChanged(int ms);
226 227 228 229
    /** @brief Emitted if action guard status changed */
    void actionGuardChanged(bool enabled);
    /** @brief Emitted if actiion request timeout changed */
    void actionRetransmissionTimeoutChanged(int ms);
pixhawk's avatar
pixhawk committed
230 231 232
};

#endif // MAVLINKPROTOCOL_H_