QGCXPlaneLink.h 5.82 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 39 40 41 42 43 44 45 46 47 48 49 50 51
/*=====================================================================

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 QGCXPlaneLink.h
 *   @brief X-Plane simulation link
 *   @author Lorenz Meier <mavteam@student.ethz.ch>
 *
 */

#ifndef QGCXPLANESIMULATIONLINK_H
#define QGCXPLANESIMULATIONLINK_H

#include <QString>
#include <QList>
#include <QMap>
#include <QMutex>
#include <QUdpSocket>
#include <QTimer>
#include <QProcess>
#include <LinkInterface.h>
#include <configuration.h>
#include "UASInterface.h"
#include "QGCHilLink.h"

class QGCXPlaneLink : public QGCHilLink
{
    Q_OBJECT
    //Q_INTERFACES(QGCXPlaneLinkInterface:LinkInterface)

public:
52
    QGCXPlaneLink(UASInterface* mav, QString remoteHost=QString("127.0.0.1:49000"), QHostAddress localHost = QHostAddress::Any, quint16 localPort = 49005);
53 54
    ~QGCXPlaneLink();

Lorenz Meier's avatar
Lorenz Meier committed
55 56 57 58 59 60 61 62 63 64
    /**
     * @brief Load X-Plane HIL settings
     */
    void loadSettings();

    /**
     * @brief Store X-Plane HIL settings
     */
    void storeSettings();

65 66 67
    bool isConnected();
    qint64 bytesAvailable();
    int getPort() const {
68
        return localPort;
69 70 71 72 73 74 75 76 77
    }

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

    void run();

Lorenz Meier's avatar
Lorenz Meier committed
78 79 80 81 82 83
    /**
     * @brief Get remote host and port
     * @return string in format <host>:<port>
     */
    QString getRemoteHost();

84 85 86 87 88 89 90 91 92 93
    enum AIRFRAME
    {
        AIRFRAME_UNKNOWN = 0,
        AIRFRAME_QUAD_DJI_F450_PWM,
        AIRFRAME_QUAD_X_MK_10INCH_I2C,
        AIRFRAME_QUAD_X_ARDRONE,
        AIRFRAME_FIXED_WING_BIXLER_II,
        AIRFRAME_FIXED_WING_BIXLER_II_AILERONS
    };

94 95 96 97 98 99 100 101 102 103 104 105 106 107
    QString getVersion()
    {
        return QString("X-Plane %1").arg(xPlaneVersion);
    }

    int getAirFrameIndex()
    {
        return (int)airframeID;
    }

    bool sensorHilEnabled() {
        return _sensorHilEnabled;
    }

108 109 110 111 112 113 114
public slots:
//    void setAddress(QString address);
    void setPort(int port);
    /** @brief Add a new host to broadcast messages to */
    void setRemoteHost(const QString& host);
    /** @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);
115 116
    /** @brief Send new motor control states to the simulation */
    void updateActuators(uint64_t time, float act1, float act2, float act3, float act4, float act5, float act6, float act7, float act8);
Lorenz Meier's avatar
Lorenz Meier committed
117 118
    /** @brief Set the simulator version as text string */
    void setVersion(const QString& version);
Lorenz Meier's avatar
Lorenz Meier committed
119 120
    /** @brief Set the simulator version as integer */
    void setVersion(unsigned int version);
Lorenz Meier's avatar
Lorenz Meier committed
121

122 123 124 125
    void enableSensorHIL(bool enable) {
        if (enable != _sensorHilEnabled)
            _sensorHilEnabled = enable;
            emit sensorHilChanged(enable);
Lorenz Meier's avatar
Lorenz Meier committed
126 127
    }

128 129 130 131 132 133 134 135 136 137 138 139
    void processError(QProcess::ProcessError err);

    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);
    bool connectSimulation();
    bool disconnectSimulation();
140 141 142 143
    /**
     * @brief Select airplane model
     * @param plane the name of the airplane
     */
Lorenz Meier's avatar
Lorenz Meier committed
144
    void selectAirframe(const QString& airframe);
145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164
    /**
     * @brief Set the airplane position and attitude
     * @param lat
     * @param lon
     * @param alt
     * @param roll
     * @param pitch
     * @param yaw
     */
    void setPositionAttitude(double lat, double lon, double alt, double roll, double pitch, double yaw);

    /**
     * @brief Set a random position
     */
    void setRandomPosition();

    /**
     * @brief Set a random attitude
     */
    void setRandomAttitude();
165 166

protected:
167
    UASInterface* mav;
168
    QString name;
169 170 171 172
    QHostAddress localHost;
    quint16 localPort;
    QHostAddress remoteHost;
    quint16 remotePort;
173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189
    int id;
    QUdpSocket* socket;
    bool connectState;

    quint64 bitsSentTotal;
    quint64 bitsSentCurrent;
    quint64 bitsSentMax;
    quint64 bitsReceivedTotal;
    quint64 bitsReceivedCurrent;
    quint64 bitsReceivedMax;
    quint64 connectionStartTime;
    QMutex statisticsMutex;
    QMutex dataMutex;
    QTimer refreshTimer;
    QProcess* process;
    QProcess* terraSync;

190 191 192
    bool gpsReceived;
    bool attitudeReceived;

193 194 195
    float roll, pitch, yaw, rollspeed, pitchspeed, yawspeed;
    double lat, lon, alt;
    float vx, vy, vz, xacc, yacc, zacc;
196 197
    float ind_airspeed;
    float true_airspeed;
198
    float groundspeed;
Lorenz Meier's avatar
Lorenz Meier committed
199
    float xmag, ymag, zmag, abs_pressure, diff_pressure, pressure_alt, temperature;
200
    float barometerOffsetkPa;
201 202

    float man_roll, man_pitch, man_yaw;
203 204 205
    QString airframeName;
    enum AIRFRAME airframeID;
    bool xPlaneConnected;
Lorenz Meier's avatar
Lorenz Meier committed
206
    unsigned int xPlaneVersion;
207
    quint64 simUpdateLast;
208
    quint64 simUpdateFirst;
209
    quint64 simUpdateLastText;
210
    quint64 simUpdateLastGroundTruth;
211
    float simUpdateHz;
212
    bool _sensorHilEnabled;
213

214 215 216 217
    void setName(QString name);
};

#endif // QGCXPLANESIMULATIONLINK_H