QGCFlightGearLink.h 4.05 KB
Newer Older
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
/*=====================================================================

QGroundControl Open Source Ground Control Station

(c) 2009 - 2011 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/>.

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

/**
 * @file
 *   @brief UDP connection (server) for unmanned vehicles
 *   @author Lorenz Meier <mavteam@student.ethz.ch>
 *
 */

#ifndef QGCFLIGHTGEARLINK_H
#define QGCFLIGHTGEARLINK_H

#include <QString>
#include <QList>
#include <QMap>
#include <QMutex>
#include <QUdpSocket>
lm's avatar
lm committed
39
#include <QTimer>
lm's avatar
lm committed
40
#include <QProcess>
41 42
#include <LinkInterface.h>
#include <configuration.h>
lm's avatar
lm committed
43
#include "UASInterface.h"
44 45 46 47 48 49 50

class QGCFlightGearLink : public QThread
{
    Q_OBJECT
    //Q_INTERFACES(QGCFlightGearLinkInterface:LinkInterface)

public:
lm's avatar
lm committed
51
    QGCFlightGearLink(UASInterface* mav, QString remoteHost=QString("127.0.0.1:49000"), QHostAddress host = QHostAddress::Any, quint16 port = 49005);
52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67
    ~QGCFlightGearLink();

    bool isConnected();
    qint64 bytesAvailable();
    int getPort() const {
        return port;
    }

    /**
     * @brief The human readable port name
     */
    QString getName();

    void run();

public slots:
lm's avatar
lm committed
68
//    void setAddress(QString address);
69 70
    void setPort(int port);
    /** @brief Add a new host to broadcast messages to */
lm's avatar
lm committed
71
    void setRemoteHost(const QString& host);
lm's avatar
lm committed
72 73
    /** @brief Send new control states to the simulation */
    void updateControls(uint64_t time, float rollAilerons, float pitchElevator, float yawRudder, float throttle, uint8_t systemMode, uint8_t navMode);
lm's avatar
lm committed
74 75
//    /** @brief Remove a host from broadcasting messages to */
//    void removeHost(const QString& host);
76
    //    void readPendingDatagrams();
lm's avatar
lm committed
77
    void processError(QProcess::ProcessError err);
78 79 80 81 82 83 84 85 86

    void readBytes();
    /**
     * @brief Write a number of bytes to the interface.
     *
     * @param data Pointer to the data byte array
     * @param size The size of the bytes array
     **/
    void writeBytes(const char* data, qint64 length);
lm's avatar
lm committed
87 88
    bool connectSimulation();
    bool disconnectSimulation();
89 90 91 92

protected:
    QString name;
    QHostAddress host;
lm's avatar
lm committed
93 94
    QHostAddress currentHost;
    quint16 currentPort;
95 96 97 98 99 100 101 102 103 104 105 106 107 108
    quint16 port;
    int id;
    QUdpSocket* socket;
    bool connectState;

    quint64 bitsSentTotal;
    quint64 bitsSentCurrent;
    quint64 bitsSentMax;
    quint64 bitsReceivedTotal;
    quint64 bitsReceivedCurrent;
    quint64 bitsReceivedMax;
    quint64 connectionStartTime;
    QMutex statisticsMutex;
    QMutex dataMutex;
lm's avatar
lm committed
109
    QTimer refreshTimer;
lm's avatar
lm committed
110 111
    UASInterface* mav;
    QProcess* process;
lm's avatar
lm committed
112
    QProcess* terraSync;
113 114 115 116

    void setName(QString name);

signals:
lm's avatar
lm committed
117 118 119 120 121 122 123 124 125 126 127 128 129 130 131
    /**
     * @brief This signal is emitted instantly when the link is connected
     **/
    void flightGearConnected();

    /**
     * @brief This signal is emitted instantly when the link is disconnected
     **/
    void flightGearDisconnected();

    /**
     * @brief This signal is emitted instantly when the link status changes
     **/
    void flightGearConnected(bool connected);

lm's avatar
lm committed
132 133 134 135 136
    /** @brief State update from FlightGear */
    void hilStateChanged(uint64_t time_us, float roll, float pitch, float yaw, float rollspeed,
                        float pitchspeed, float yawspeed, int32_t lat, int32_t lon, int32_t alt,
                        int16_t vx, int16_t vy, int16_t vz, int16_t xacc, int16_t yacc, int16_t zacc);

137 138 139 140

};

#endif // QGCFLIGHTGEARLINK_H