Vehicle.h 77.7 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.
 *
 ****************************************************************************/
dogmaphobic's avatar
dogmaphobic committed
9

10
#pragma once
11 12

#include <QObject>
13
#include <QVariantList>
14
#include <QGeoCoordinate>
15

Don Gagne's avatar
Don Gagne committed
16
#include "FactGroup.h"
17 18
#include "LinkInterface.h"
#include "QGCMAVLink.h"
19
#include "QmlObjectListModel.h"
Don Gagne's avatar
Don Gagne committed
20
#include "MAVLinkProtocol.h"
dogmaphobic's avatar
dogmaphobic committed
21
#include "UASMessageHandler.h"
22
#include "SettingsFact.h"
23

24 25
class UAS;
class UASInterface;
26
class FirmwarePlugin;
27
class FirmwarePluginManager;
28
class AutoPilotPlugin;
Don Gagne's avatar
Don Gagne committed
29
class MissionManager;
30
class GeoFenceManager;
31
class RallyPointManager;
32
class ParameterManager;
33
class JoystickManager;
dogmaphobic's avatar
dogmaphobic committed
34
class UASMessage;
35
class SettingsManager;
36
class ADSBVehicle;
37
class QGCCameraManager;
38 39 40
#if defined(QGC_AIRMAP_ENABLED)
class AirspaceVehicleManager;
#endif
41 42 43

Q_DECLARE_LOGGING_CATEGORY(VehicleLog)

Don Gagne's avatar
Don Gagne committed
44 45
class Vehicle;

46 47 48 49 50
class VehicleDistanceSensorFactGroup : public FactGroup
{
    Q_OBJECT

public:
51
    VehicleDistanceSensorFactGroup(QObject* parent = nullptr);
52

53 54 55 56 57 58 59 60 61 62
    Q_PROPERTY(Fact* rotationNone       READ rotationNone       CONSTANT)
    Q_PROPERTY(Fact* rotationYaw45      READ rotationYaw45      CONSTANT)
    Q_PROPERTY(Fact* rotationYaw90      READ rotationYaw90      CONSTANT)
    Q_PROPERTY(Fact* rotationYaw135     READ rotationYaw135     CONSTANT)
    Q_PROPERTY(Fact* rotationYaw180     READ rotationYaw180     CONSTANT)
    Q_PROPERTY(Fact* rotationYaw225     READ rotationYaw225     CONSTANT)
    Q_PROPERTY(Fact* rotationYaw270     READ rotationYaw270     CONSTANT)
    Q_PROPERTY(Fact* rotationYaw315     READ rotationYaw315     CONSTANT)
    Q_PROPERTY(Fact* rotationPitch90    READ rotationPitch90    CONSTANT)
    Q_PROPERTY(Fact* rotationPitch270   READ rotationPitch270   CONSTANT)
63 64

    Fact* rotationNone      (void) { return &_rotationNoneFact; }
65
    Fact* rotationYaw45     (void) { return &_rotationYaw45Fact; }
66
    Fact* rotationYaw90     (void) { return &_rotationYaw90Fact; }
67
    Fact* rotationYaw135    (void) { return &_rotationYaw90Fact; }
68
    Fact* rotationYaw180    (void) { return &_rotationYaw180Fact; }
69
    Fact* rotationYaw225    (void) { return &_rotationYaw180Fact; }
70
    Fact* rotationYaw270    (void) { return &_rotationYaw270Fact; }
71 72 73 74 75 76
    Fact* rotationYaw315    (void) { return &_rotationYaw315Fact; }
    Fact* rotationPitch90   (void) { return &_rotationPitch90Fact; }
    Fact* rotationPitch270  (void) { return &_rotationPitch270Fact; }

    bool idSet(void) { return _idSet; }
    void setIdSet(bool idSet) { _idSet = idSet; }
77 78
    uint8_t id(void) { return _id; }
    void setId(uint8_t id) { _id = id; }
79 80

    static const char* _rotationNoneFactName;
81
    static const char* _rotationYaw45FactName;
82
    static const char* _rotationYaw90FactName;
83
    static const char* _rotationYaw135FactName;
84
    static const char* _rotationYaw180FactName;
85
    static const char* _rotationYaw225FactName;
86
    static const char* _rotationYaw270FactName;
87 88 89
    static const char* _rotationYaw315FactName;
    static const char* _rotationPitch90FactName;
    static const char* _rotationPitch270FactName;
90 91 92

private:
    Fact _rotationNoneFact;
93
    Fact _rotationYaw45Fact;
94
    Fact _rotationYaw90Fact;
95
    Fact _rotationYaw135Fact;
96
    Fact _rotationYaw180Fact;
97
    Fact _rotationYaw225Fact;
98
    Fact _rotationYaw270Fact;
99 100 101 102 103 104
    Fact _rotationYaw315Fact;
    Fact _rotationPitch90Fact;
    Fact _rotationPitch270Fact;

    bool    _idSet; // true: _id is set to seen sensor id
    uint8_t _id;    // The id for the sensor being tracked. Current support for only a single sensor.
105 106
};

DonLakeFlyer's avatar
DonLakeFlyer committed
107 108 109 110 111
class VehicleSetpointFactGroup : public FactGroup
{
    Q_OBJECT

public:
112
    VehicleSetpointFactGroup(QObject* parent = nullptr);
DonLakeFlyer's avatar
DonLakeFlyer committed
113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143

    Q_PROPERTY(Fact* roll       READ roll       CONSTANT)
    Q_PROPERTY(Fact* pitch      READ pitch      CONSTANT)
    Q_PROPERTY(Fact* yaw        READ yaw        CONSTANT)
    Q_PROPERTY(Fact* rollRate   READ rollRate   CONSTANT)
    Q_PROPERTY(Fact* pitchRate  READ pitchRate  CONSTANT)
    Q_PROPERTY(Fact* yawRate    READ yawRate    CONSTANT)

    Fact* roll      (void) { return &_rollFact; }
    Fact* pitch     (void) { return &_pitchFact; }
    Fact* yaw       (void) { return &_yawFact; }
    Fact* rollRate  (void) { return &_rollRateFact; }
    Fact* pitchRate (void) { return &_pitchRateFact; }
    Fact* yawRate   (void) { return &_yawRateFact; }

    static const char* _rollFactName;
    static const char* _pitchFactName;
    static const char* _yawFactName;
    static const char* _rollRateFactName;
    static const char* _pitchRateFactName;
    static const char* _yawRateFactName;

private:
    Fact _rollFact;
    Fact _pitchFact;
    Fact _yawFact;
    Fact _rollRateFact;
    Fact _pitchRateFact;
    Fact _yawRateFact;
};

144 145 146 147 148
class VehicleVibrationFactGroup : public FactGroup
{
    Q_OBJECT

public:
149
    VehicleVibrationFactGroup(QObject* parent = nullptr);
150 151 152 153 154 155 156 157

    Q_PROPERTY(Fact* xAxis      READ xAxis      CONSTANT)
    Q_PROPERTY(Fact* yAxis      READ yAxis      CONSTANT)
    Q_PROPERTY(Fact* zAxis      READ zAxis      CONSTANT)
    Q_PROPERTY(Fact* clipCount1 READ clipCount1 CONSTANT)
    Q_PROPERTY(Fact* clipCount2 READ clipCount2 CONSTANT)
    Q_PROPERTY(Fact* clipCount3 READ clipCount3 CONSTANT)

158 159 160 161 162 163
    Fact* xAxis         (void) { return &_xAxisFact; }
    Fact* yAxis         (void) { return &_yAxisFact; }
    Fact* zAxis         (void) { return &_zAxisFact; }
    Fact* clipCount1    (void) { return &_clipCount1Fact; }
    Fact* clipCount2    (void) { return &_clipCount2Fact; }
    Fact* clipCount3    (void) { return &_clipCount3Fact; }
164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180

    static const char* _xAxisFactName;
    static const char* _yAxisFactName;
    static const char* _zAxisFactName;
    static const char* _clipCount1FactName;
    static const char* _clipCount2FactName;
    static const char* _clipCount3FactName;

private:
    Fact        _xAxisFact;
    Fact        _yAxisFact;
    Fact        _zAxisFact;
    Fact        _clipCount1Fact;
    Fact        _clipCount2Fact;
    Fact        _clipCount3Fact;
};

Don Gagne's avatar
Don Gagne committed
181 182 183 184 185
class VehicleWindFactGroup : public FactGroup
{
    Q_OBJECT

public:
186
    VehicleWindFactGroup(QObject* parent = nullptr);
Don Gagne's avatar
Don Gagne committed
187 188 189 190 191

    Q_PROPERTY(Fact* direction      READ direction      CONSTANT)
    Q_PROPERTY(Fact* speed          READ speed          CONSTANT)
    Q_PROPERTY(Fact* verticalSpeed  READ verticalSpeed  CONSTANT)

192 193 194
    Fact* direction     (void) { return &_directionFact; }
    Fact* speed         (void) { return &_speedFact; }
    Fact* verticalSpeed (void) { return &_verticalSpeedFact; }
Don Gagne's avatar
Don Gagne committed
195 196 197 198 199 200 201 202 203 204 205

    static const char* _directionFactName;
    static const char* _speedFactName;
    static const char* _verticalSpeedFactName;

private:
    Fact        _directionFact;
    Fact        _speedFact;
    Fact        _verticalSpeedFact;
};

Don Gagne's avatar
Don Gagne committed
206 207 208 209 210
class VehicleGPSFactGroup : public FactGroup
{
    Q_OBJECT

public:
211
    VehicleGPSFactGroup(QObject* parent = nullptr);
Don Gagne's avatar
Don Gagne committed
212

213 214
    Q_PROPERTY(Fact* lat                READ lat                CONSTANT)
    Q_PROPERTY(Fact* lon                READ lon                CONSTANT)
Don Gagne's avatar
Don Gagne committed
215 216 217 218 219 220
    Q_PROPERTY(Fact* hdop               READ hdop               CONSTANT)
    Q_PROPERTY(Fact* vdop               READ vdop               CONSTANT)
    Q_PROPERTY(Fact* courseOverGround   READ courseOverGround   CONSTANT)
    Q_PROPERTY(Fact* count              READ count              CONSTANT)
    Q_PROPERTY(Fact* lock               READ lock               CONSTANT)

221 222
    Fact* lat               (void) { return &_latFact; }
    Fact* lon               (void) { return &_lonFact; }
223 224 225 226 227
    Fact* hdop              (void) { return &_hdopFact; }
    Fact* vdop              (void) { return &_vdopFact; }
    Fact* courseOverGround  (void) { return &_courseOverGroundFact; }
    Fact* count             (void) { return &_countFact; }
    Fact* lock              (void) { return &_lockFact; }
Don Gagne's avatar
Don Gagne committed
228

229 230
    static const char* _latFactName;
    static const char* _lonFactName;
Don Gagne's avatar
Don Gagne committed
231 232 233 234 235 236
    static const char* _hdopFactName;
    static const char* _vdopFactName;
    static const char* _courseOverGroundFactName;
    static const char* _countFactName;
    static const char* _lockFactName;

Don Gagne's avatar
Don Gagne committed
237
private:
238 239
    Fact        _latFact;
    Fact        _lonFact;
Don Gagne's avatar
Don Gagne committed
240 241 242 243 244
    Fact        _hdopFact;
    Fact        _vdopFact;
    Fact        _courseOverGroundFact;
    Fact        _countFact;
    Fact        _lockFact;
Don Gagne's avatar
Don Gagne committed
245
};
Don Gagne's avatar
Don Gagne committed
246

Don Gagne's avatar
Don Gagne committed
247 248 249 250 251
class VehicleBatteryFactGroup : public FactGroup
{
    Q_OBJECT

public:
252
    VehicleBatteryFactGroup(QObject* parent = nullptr);
Don Gagne's avatar
Don Gagne committed
253 254 255 256 257 258

    Q_PROPERTY(Fact* voltage            READ voltage            CONSTANT)
    Q_PROPERTY(Fact* percentRemaining   READ percentRemaining   CONSTANT)
    Q_PROPERTY(Fact* mahConsumed        READ mahConsumed        CONSTANT)
    Q_PROPERTY(Fact* current            READ current            CONSTANT)
    Q_PROPERTY(Fact* temperature        READ temperature        CONSTANT)
259
    Q_PROPERTY(Fact* cellCount          READ cellCount          CONSTANT)
260
    Q_PROPERTY(Fact* instantPower       READ instantPower       CONSTANT)
261 262
    Q_PROPERTY(Fact* timeRemaining      READ timeRemaining      CONSTANT)
    Q_PROPERTY(Fact* chargeState        READ chargeState        CONSTANT)
263 264 265 266 267 268 269

    Fact* voltage                   (void) { return &_voltageFact; }
    Fact* percentRemaining          (void) { return &_percentRemainingFact; }
    Fact* mahConsumed               (void) { return &_mahConsumedFact; }
    Fact* current                   (void) { return &_currentFact; }
    Fact* temperature               (void) { return &_temperatureFact; }
    Fact* cellCount                 (void) { return &_cellCountFact; }
270
    Fact* instantPower              (void) { return &_instantPowerFact; }
271 272
    Fact* timeRemaining             (void) { return &_timeRemainingFact; }
    Fact* chargeState               (void) { return &_chargeStateFact; }
Don Gagne's avatar
Don Gagne committed
273 274 275 276 277 278 279

    static const char* _voltageFactName;
    static const char* _percentRemainingFactName;
    static const char* _mahConsumedFactName;
    static const char* _currentFactName;
    static const char* _temperatureFactName;
    static const char* _cellCountFactName;
280
    static const char* _instantPowerFactName;
281 282
    static const char* _timeRemainingFactName;
    static const char* _chargeStateFactName;
Don Gagne's avatar
Don Gagne committed
283

284 285
    static const char* _settingsGroup;

Don Gagne's avatar
Don Gagne committed
286 287 288 289 290 291
    static const double _voltageUnavailable;
    static const int    _percentRemainingUnavailable;
    static const int    _mahConsumedUnavailable;
    static const int    _currentUnavailable;
    static const double _temperatureUnavailable;
    static const int    _cellCountUnavailable;
292
    static const double _instantPowerUnavailable;
Don Gagne's avatar
Don Gagne committed
293 294

private:
295 296 297 298 299 300
    Fact            _voltageFact;
    Fact            _percentRemainingFact;
    Fact            _mahConsumedFact;
    Fact            _currentFact;
    Fact            _temperatureFact;
    Fact            _cellCountFact;
301
    Fact            _instantPowerFact;
302 303
    Fact            _timeRemainingFact;
    Fact            _chargeStateFact;
Don Gagne's avatar
Don Gagne committed
304 305
};

306 307 308 309 310
class VehicleTemperatureFactGroup : public FactGroup
{
    Q_OBJECT

public:
311
    VehicleTemperatureFactGroup(QObject* parent = nullptr);
312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334

    Q_PROPERTY(Fact* temperature1       READ temperature1       CONSTANT)
    Q_PROPERTY(Fact* temperature2       READ temperature2       CONSTANT)
    Q_PROPERTY(Fact* temperature3       READ temperature3       CONSTANT)

    Fact* temperature1 (void) { return &_temperature1Fact; }
    Fact* temperature2 (void) { return &_temperature2Fact; }
    Fact* temperature3 (void) { return &_temperature3Fact; }

    static const char* _temperature1FactName;
    static const char* _temperature2FactName;
    static const char* _temperature3FactName;

    static const char* _settingsGroup;

    static const double _temperatureUnavailable;

private:
    Fact            _temperature1Fact;
    Fact            _temperature2Fact;
    Fact            _temperature3Fact;
};

dheideman's avatar
dheideman committed
335 336 337 338 339
class VehicleClockFactGroup : public FactGroup
{
    Q_OBJECT

public:
340
    VehicleClockFactGroup(QObject* parent = nullptr);
dheideman's avatar
dheideman committed
341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360

    Q_PROPERTY(Fact* currentTime        READ currentTime        CONSTANT)
    Q_PROPERTY(Fact* currentDate        READ currentDate        CONSTANT)

    Fact* currentTime (void) { return &_currentTimeFact; }
    Fact* currentDate (void) { return &_currentDateFact; }

    static const char* _currentTimeFactName;
    static const char* _currentDateFactName;

    static const char* _settingsGroup;

private slots:
    void _updateAllValues(void) override;

private:
    Fact            _currentTimeFact;
    Fact            _currentDateFact;
};

361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479
class VehicleEstimatorStatusFactGroup : public FactGroup
{
    Q_OBJECT

public:
    VehicleEstimatorStatusFactGroup(QObject* parent = nullptr);

    Q_PROPERTY(Fact* goodAttitudeEstimate           READ goodAttitudeEstimate           CONSTANT)
    Q_PROPERTY(Fact* goodHorizVelEstimate           READ goodHorizVelEstimate           CONSTANT)
    Q_PROPERTY(Fact* goodVertVelEstimate            READ goodVertVelEstimate            CONSTANT)
    Q_PROPERTY(Fact* goodHorizPosRelEstimate        READ goodHorizPosRelEstimate        CONSTANT)
    Q_PROPERTY(Fact* goodHorizPosAbsEstimate        READ goodHorizPosAbsEstimate        CONSTANT)
    Q_PROPERTY(Fact* goodVertPosAbsEstimate         READ goodVertPosAbsEstimate         CONSTANT)
    Q_PROPERTY(Fact* goodVertPosAGLEstimate         READ goodVertPosAGLEstimate         CONSTANT)
    Q_PROPERTY(Fact* goodConstPosModeEstimate       READ goodConstPosModeEstimate       CONSTANT)
    Q_PROPERTY(Fact* goodPredHorizPosRelEstimate    READ goodPredHorizPosRelEstimate    CONSTANT)
    Q_PROPERTY(Fact* goodPredHorizPosAbsEstimate    READ goodPredHorizPosAbsEstimate    CONSTANT)
    Q_PROPERTY(Fact* gpsGlitch                      READ gpsGlitch                      CONSTANT)
    Q_PROPERTY(Fact* accelError                     READ accelError                     CONSTANT)
    Q_PROPERTY(Fact* velRatio                       READ velRatio                       CONSTANT)
    Q_PROPERTY(Fact* horizPosRatio                  READ horizPosRatio                  CONSTANT)
    Q_PROPERTY(Fact* vertPosRatio                   READ vertPosRatio                   CONSTANT)
    Q_PROPERTY(Fact* magRatio                       READ magRatio                       CONSTANT)
    Q_PROPERTY(Fact* haglRatio                      READ haglRatio                      CONSTANT)
    Q_PROPERTY(Fact* tasRatio                       READ tasRatio                       CONSTANT)
    Q_PROPERTY(Fact* horizPosAccuracy               READ horizPosAccuracy               CONSTANT)
    Q_PROPERTY(Fact* vertPosAccuracy                READ vertPosAccuracy                CONSTANT)

    Fact* goodAttitudeEstimate          (void) { return &_goodAttitudeEstimateFact; }
    Fact* goodHorizVelEstimate          (void) { return &_goodHorizVelEstimateFact; }
    Fact* goodVertVelEstimate           (void) { return &_goodVertVelEstimateFact; }
    Fact* goodHorizPosRelEstimate       (void) { return &_goodHorizPosRelEstimateFact; }
    Fact* goodHorizPosAbsEstimate       (void) { return &_goodHorizPosAbsEstimateFact; }
    Fact* goodVertPosAbsEstimate        (void) { return &_goodVertPosAbsEstimateFact; }
    Fact* goodVertPosAGLEstimate        (void) { return &_goodVertPosAGLEstimateFact; }
    Fact* goodConstPosModeEstimate      (void) { return &_goodConstPosModeEstimateFact; }
    Fact* goodPredHorizPosRelEstimate   (void) { return &_goodPredHorizPosRelEstimateFact; }
    Fact* goodPredHorizPosAbsEstimate   (void) { return &_goodPredHorizPosAbsEstimateFact; }
    Fact* gpsGlitch                     (void) { return &_gpsGlitchFact; }
    Fact* accelError                    (void) { return &_accelErrorFact; }
    Fact* velRatio                      (void) { return &_velRatioFact; }
    Fact* horizPosRatio                 (void) { return &_horizPosRatioFact; }
    Fact* vertPosRatio                  (void) { return &_vertPosRatioFact; }
    Fact* magRatio                      (void) { return &_magRatioFact; }
    Fact* haglRatio                     (void) { return &_haglRatioFact; }
    Fact* tasRatio                      (void) { return &_tasRatioFact; }
    Fact* horizPosAccuracy              (void) { return &_horizPosAccuracyFact; }
    Fact* vertPosAccuracy               (void) { return &_vertPosAccuracyFact; }

    static const char* _goodAttitudeEstimateFactName;
    static const char* _goodHorizVelEstimateFactName;
    static const char* _goodVertVelEstimateFactName;
    static const char* _goodHorizPosRelEstimateFactName;
    static const char* _goodHorizPosAbsEstimateFactName;
    static const char* _goodVertPosAbsEstimateFactName;
    static const char* _goodVertPosAGLEstimateFactName;
    static const char* _goodConstPosModeEstimateFactName;
    static const char* _goodPredHorizPosRelEstimateFactName;
    static const char* _goodPredHorizPosAbsEstimateFactName;
    static const char* _gpsGlitchFactName;
    static const char* _accelErrorFactName;
    static const char* _velRatioFactName;
    static const char* _horizPosRatioFactName;
    static const char* _vertPosRatioFactName;
    static const char* _magRatioFactName;
    static const char* _haglRatioFactName;
    static const char* _tasRatioFactName;
    static const char* _horizPosAccuracyFactName;
    static const char* _vertPosAccuracyFactName;

private:
    Fact _goodAttitudeEstimateFact;
    Fact _goodHorizVelEstimateFact;
    Fact _goodVertVelEstimateFact;
    Fact _goodHorizPosRelEstimateFact;
    Fact _goodHorizPosAbsEstimateFact;
    Fact _goodVertPosAbsEstimateFact;
    Fact _goodVertPosAGLEstimateFact;
    Fact _goodConstPosModeEstimateFact;
    Fact _goodPredHorizPosRelEstimateFact;
    Fact _goodPredHorizPosAbsEstimateFact;
    Fact _gpsGlitchFact;
    Fact _accelErrorFact;
    Fact _velRatioFact;
    Fact _horizPosRatioFact;
    Fact _vertPosRatioFact;
    Fact _magRatioFact;
    Fact _haglRatioFact;
    Fact _tasRatioFact;
    Fact _horizPosAccuracyFact;
    Fact _vertPosAccuracyFact;

#if 0
    typedef enum ESTIMATOR_STATUS_FLAGS
    {
       ESTIMATOR_ATTITUDE=1, /* True if the attitude estimate is good | */
       ESTIMATOR_VELOCITY_HORIZ=2, /* True if the horizontal velocity estimate is good | */
       ESTIMATOR_VELOCITY_VERT=4, /* True if the  vertical velocity estimate is good | */
       ESTIMATOR_POS_HORIZ_REL=8, /* True if the horizontal position (relative) estimate is good | */
       ESTIMATOR_POS_HORIZ_ABS=16, /* True if the horizontal position (absolute) estimate is good | */
       ESTIMATOR_POS_VERT_ABS=32, /* True if the vertical position (absolute) estimate is good | */
       ESTIMATOR_POS_VERT_AGL=64, /* True if the vertical position (above ground) estimate is good | */
       ESTIMATOR_CONST_POS_MODE=128, /* True if the EKF is in a constant position mode and is not using external measurements (eg GPS or optical flow) | */
       ESTIMATOR_PRED_POS_HORIZ_REL=256, /* True if the EKF has sufficient data to enter a mode that will provide a (relative) position estimate | */
       ESTIMATOR_PRED_POS_HORIZ_ABS=512, /* True if the EKF has sufficient data to enter a mode that will provide a (absolute) position estimate | */
       ESTIMATOR_GPS_GLITCH=1024, /* True if the EKF has detected a GPS glitch | */
       ESTIMATOR_ACCEL_ERROR=2048, /* True if the EKF has detected bad accelerometer data | */

        typedef struct __mavlink_estimator_status_t {
         uint64_t time_usec; /*< Timestamp (micros since boot or Unix epoch)*/
         float vel_ratio; /*< Velocity innovation test ratio*/
         float pos_horiz_ratio; /*< Horizontal position innovation test ratio*/
         float pos_vert_ratio; /*< Vertical position innovation test ratio*/
         float mag_ratio; /*< Magnetometer innovation test ratio*/
         float hagl_ratio; /*< Height above terrain innovation test ratio*/
         float tas_ratio; /*< True airspeed innovation test ratio*/
         float pos_horiz_accuracy; /*< Horizontal position 1-STD accuracy relative to the EKF local origin (m)*/
         float pos_vert_accuracy; /*< Vertical position 1-STD accuracy relative to the EKF local origin (m)*/
         uint16_t flags; /*< Integer bitmask indicating which EKF outputs are valid. See definition for ESTIMATOR_STATUS_FLAGS.*/
480 481
        } mavlink_estimator_status_t;
    };
482 483 484 485
#endif
};


Don Gagne's avatar
Don Gagne committed
486
class Vehicle : public FactGroup
487 488
{
    Q_OBJECT
dogmaphobic's avatar
dogmaphobic committed
489

490
public:
491 492
    Vehicle(LinkInterface*          link,
            int                     vehicleId,
493
            int                     defaultComponentId,
494 495 496 497
            MAV_AUTOPILOT           firmwareType,
            MAV_TYPE                vehicleType,
            FirmwarePluginManager*  firmwarePluginManager,
            JoystickManager*        joystickManager);
498

499 500 501 502 503
    // The following is used to create a disconnected Vehicle for use while offline editing.
    Vehicle(MAV_AUTOPILOT           firmwareType,
            MAV_TYPE                vehicleType,
            FirmwarePluginManager*  firmwarePluginManager,
            QObject*                parent = NULL);
504

505
    ~Vehicle();
dogmaphobic's avatar
dogmaphobic committed
506

507 508 509 510 511
    /// Sensor bits from sensors*Bits properties
    enum MavlinkSysStatus {
        SysStatusSensor3dGyro =                 MAV_SYS_STATUS_SENSOR_3D_GYRO,
        SysStatusSensor3dAccel =                MAV_SYS_STATUS_SENSOR_3D_ACCEL,
        SysStatusSensor3dMag =                  MAV_SYS_STATUS_SENSOR_3D_MAG,
512
        SysStatusSensorAbsolutePressure =       MAV_SYS_STATUS_SENSOR_ABSOLUTE_PRESSURE,
513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535 536 537
        SysStatusSensorDifferentialPressure =   MAV_SYS_STATUS_SENSOR_DIFFERENTIAL_PRESSURE,
        SysStatusSensorGPS =                    MAV_SYS_STATUS_SENSOR_GPS,
        SysStatusSensorOpticalFlow =            MAV_SYS_STATUS_SENSOR_OPTICAL_FLOW,
        SysStatusSensorVisionPosition =         MAV_SYS_STATUS_SENSOR_VISION_POSITION,
        SysStatusSensorLaserPosition =          MAV_SYS_STATUS_SENSOR_LASER_POSITION,
        SysStatusSensorExternalGroundTruth =    MAV_SYS_STATUS_SENSOR_EXTERNAL_GROUND_TRUTH,
        SysStatusSensorAngularRateControl =     MAV_SYS_STATUS_SENSOR_ANGULAR_RATE_CONTROL,
        SysStatusSensorAttitudeStabilization =  MAV_SYS_STATUS_SENSOR_ATTITUDE_STABILIZATION,
        SysStatusSensorYawPosition =            MAV_SYS_STATUS_SENSOR_YAW_POSITION,
        SysStatusSensorZAltitudeControl =       MAV_SYS_STATUS_SENSOR_Z_ALTITUDE_CONTROL,
        SysStatusSensorXYPositionControl =      MAV_SYS_STATUS_SENSOR_XY_POSITION_CONTROL,
        SysStatusSensorMotorOutputs =           MAV_SYS_STATUS_SENSOR_MOTOR_OUTPUTS,
        SysStatusSensorRCReceiver =             MAV_SYS_STATUS_SENSOR_RC_RECEIVER,
        SysStatusSensor3dGyro2 =                MAV_SYS_STATUS_SENSOR_3D_GYRO2,
        SysStatusSensor3dAccel2 =               MAV_SYS_STATUS_SENSOR_3D_ACCEL2,
        SysStatusSensor3dMag2 =                 MAV_SYS_STATUS_SENSOR_3D_MAG2,
        SysStatusSensorGeoFence =               MAV_SYS_STATUS_GEOFENCE,
        SysStatusSensorAHRS =                   MAV_SYS_STATUS_AHRS,
        SysStatusSensorTerrain =                MAV_SYS_STATUS_TERRAIN,
        SysStatusSensorReverseMotor =           MAV_SYS_STATUS_REVERSE_MOTOR,
        SysStatusSensorLogging =                MAV_SYS_STATUS_LOGGING,
        SysStatusSensorBattery =                MAV_SYS_STATUS_SENSOR_BATTERY,
    };
    Q_ENUM(MavlinkSysStatus)

538 539 540 541 542
    Q_PROPERTY(int                  id                      READ id                                                     CONSTANT)
    Q_PROPERTY(AutoPilotPlugin*     autopilot               MEMBER _autopilotPlugin                                     CONSTANT)
    Q_PROPERTY(QGeoCoordinate       coordinate              READ coordinate                                             NOTIFY coordinateChanged)
    Q_PROPERTY(QGeoCoordinate       homePosition            READ homePosition                                           NOTIFY homePositionChanged)
    Q_PROPERTY(bool                 armed                   READ armed                  WRITE setArmed                  NOTIFY armedChanged)
543
    Q_PROPERTY(bool                 autoDisarm              READ autoDisarm                                             NOTIFY autoDisarmChanged)
544
    Q_PROPERTY(bool                 flightModeSetAvailable  READ flightModeSetAvailable                                 CONSTANT)
545
    Q_PROPERTY(QStringList          flightModes             READ flightModes                                            NOTIFY flightModesChanged)
546 547 548
    Q_PROPERTY(QString              flightMode              READ flightMode             WRITE setFlightMode             NOTIFY flightModeChanged)
    Q_PROPERTY(bool                 hilMode                 READ hilMode                WRITE setHilMode                NOTIFY hilModeChanged)
    Q_PROPERTY(QmlObjectListModel*  trajectoryPoints        READ trajectoryPoints                                       CONSTANT)
549
    Q_PROPERTY(QmlObjectListModel*  cameraTriggerPoints     READ cameraTriggerPoints                                    CONSTANT)
550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566
    Q_PROPERTY(float                latitude                READ latitude                                               NOTIFY coordinateChanged)
    Q_PROPERTY(float                longitude               READ longitude                                              NOTIFY coordinateChanged)
    Q_PROPERTY(bool                 messageTypeNone         READ messageTypeNone                                        NOTIFY messageTypeChanged)
    Q_PROPERTY(bool                 messageTypeNormal       READ messageTypeNormal                                      NOTIFY messageTypeChanged)
    Q_PROPERTY(bool                 messageTypeWarning      READ messageTypeWarning                                     NOTIFY messageTypeChanged)
    Q_PROPERTY(bool                 messageTypeError        READ messageTypeError                                       NOTIFY messageTypeChanged)
    Q_PROPERTY(int                  newMessageCount         READ newMessageCount                                        NOTIFY newMessageCountChanged)
    Q_PROPERTY(int                  messageCount            READ messageCount                                           NOTIFY messageCountChanged)
    Q_PROPERTY(QString              formatedMessages        READ formatedMessages                                       NOTIFY formatedMessagesChanged)
    Q_PROPERTY(QString              formatedMessage         READ formatedMessage                                        NOTIFY formatedMessageChanged)
    Q_PROPERTY(QString              latestError             READ latestError                                            NOTIFY latestErrorChanged)
    Q_PROPERTY(int                  joystickMode            READ joystickMode           WRITE setJoystickMode           NOTIFY joystickModeChanged)
    Q_PROPERTY(QStringList          joystickModes           READ joystickModes                                          CONSTANT)
    Q_PROPERTY(bool                 joystickEnabled         READ joystickEnabled        WRITE setJoystickEnabled        NOTIFY joystickEnabledChanged)
    Q_PROPERTY(bool                 active                  READ active                 WRITE setActive                 NOTIFY activeChanged)
    Q_PROPERTY(int                  flowImageIndex          READ flowImageIndex                                         NOTIFY flowImageIndexChanged)
    Q_PROPERTY(int                  rcRSSI                  READ rcRSSI                                                 NOTIFY rcRSSIChanged)
567 568
    Q_PROPERTY(bool                 px4Firmware             READ px4Firmware                                            NOTIFY firmwareTypeChanged)
    Q_PROPERTY(bool                 apmFirmware             READ apmFirmware                                            NOTIFY firmwareTypeChanged)
569 570 571 572 573 574 575
    Q_PROPERTY(bool                 soloFirmware            READ soloFirmware           WRITE setSoloFirmware           NOTIFY soloFirmwareChanged)
    Q_PROPERTY(bool                 genericFirmware         READ genericFirmware                                        CONSTANT)
    Q_PROPERTY(bool                 connectionLost          READ connectionLost                                         NOTIFY connectionLostChanged)
    Q_PROPERTY(bool                 connectionLostEnabled   READ connectionLostEnabled  WRITE setConnectionLostEnabled  NOTIFY connectionLostEnabledChanged)
    Q_PROPERTY(uint                 messagesReceived        READ messagesReceived                                       NOTIFY messagesReceivedChanged)
    Q_PROPERTY(uint                 messagesSent            READ messagesSent                                           NOTIFY messagesSentChanged)
    Q_PROPERTY(uint                 messagesLost            READ messagesLost                                           NOTIFY messagesLostChanged)
576 577 578 579 580
    Q_PROPERTY(bool                 fixedWing               READ fixedWing                                              NOTIFY vehicleTypeChanged)
    Q_PROPERTY(bool                 multiRotor              READ multiRotor                                             NOTIFY vehicleTypeChanged)
    Q_PROPERTY(bool                 vtol                    READ vtol                                                   NOTIFY vehicleTypeChanged)
    Q_PROPERTY(bool                 rover                   READ rover                                                  NOTIFY vehicleTypeChanged)
    Q_PROPERTY(bool                 sub                     READ sub                                                    NOTIFY vehicleTypeChanged)
581
    Q_PROPERTY(bool        supportsThrottleModeCenterZero   READ supportsThrottleModeCenterZero                         CONSTANT)
582
    Q_PROPERTY(bool                supportsNegativeThrust   READ supportsNegativeThrust                                 CONSTANT)
583
    Q_PROPERTY(bool                 supportsJSButton        READ supportsJSButton                                       CONSTANT)
584
    Q_PROPERTY(bool                 supportsRadio           READ supportsRadio                                          CONSTANT)
585
    Q_PROPERTY(bool               supportsMotorInterference READ supportsMotorInterference                              CONSTANT)
586 587
    Q_PROPERTY(bool                 autoDisconnect          MEMBER _autoDisconnect                                      NOTIFY autoDisconnectChanged)
    Q_PROPERTY(QString              prearmError             READ prearmError            WRITE setPrearmError            NOTIFY prearmErrorChanged)
Don Gagne's avatar
Don Gagne committed
588 589 590
    Q_PROPERTY(int                  motorCount              READ motorCount                                             CONSTANT)
    Q_PROPERTY(bool                 coaxialMotors           READ coaxialMotors                                          CONSTANT)
    Q_PROPERTY(bool                 xConfigMotors           READ xConfigMotors                                          CONSTANT)
591
    Q_PROPERTY(bool                 isOfflineEditingVehicle READ isOfflineEditingVehicle                                CONSTANT)
592 593
    Q_PROPERTY(QString              brandImageIndoor        READ brandImageIndoor                                       NOTIFY firmwareTypeChanged)
    Q_PROPERTY(QString              brandImageOutdoor       READ brandImageOutdoor                                      NOTIFY firmwareTypeChanged)
594
    Q_PROPERTY(QStringList          unhealthySensors        READ unhealthySensors                                       NOTIFY unhealthySensorsChanged)
595 596 597
    Q_PROPERTY(int                  sensorsPresentBits      READ sensorsPresentBits                                     NOTIFY sensorsPresentBitsChanged)
    Q_PROPERTY(int                  sensorsEnabledBits      READ sensorsEnabledBits                                     NOTIFY sensorsEnabledBitsChanged)
    Q_PROPERTY(int                  sensorsHealthBits       READ sensorsHealthBits                                      NOTIFY sensorsHealthBitsChanged)
598
    Q_PROPERTY(int                  sensorsUnhealthyBits    READ sensorsUnhealthyBits                                   NOTIFY sensorsUnhealthyBitsChanged) ///< Combination of enabled and health
599
    Q_PROPERTY(QString              missionFlightMode       READ missionFlightMode                                      CONSTANT)
600
    Q_PROPERTY(QString              pauseFlightMode         READ pauseFlightMode                                        CONSTANT)
601
    Q_PROPERTY(QString              rtlFlightMode           READ rtlFlightMode                                          CONSTANT)
602
    Q_PROPERTY(QString              landFlightMode          READ landFlightMode                                         CONSTANT)
603
    Q_PROPERTY(QString              takeControlFlightMode   READ takeControlFlightMode                                  CONSTANT)
604 605
    Q_PROPERTY(QString              firmwareTypeString      READ firmwareTypeString                                     NOTIFY firmwareTypeChanged)
    Q_PROPERTY(QString              vehicleTypeString       READ vehicleTypeString                                      NOTIFY vehicleTypeChanged)
606 607 608
    Q_PROPERTY(QString              vehicleImageOpaque      READ vehicleImageOpaque                                     CONSTANT)
    Q_PROPERTY(QString              vehicleImageOutline     READ vehicleImageOutline                                    CONSTANT)
    Q_PROPERTY(QString              vehicleImageCompass     READ vehicleImageCompass                                    CONSTANT)
Gus Grubba's avatar
Gus Grubba committed
609 610 611 612 613
    Q_PROPERTY(int                  telemetryRRSSI          READ telemetryRRSSI                                         NOTIFY telemetryRRSSIChanged)
    Q_PROPERTY(int                  telemetryLRSSI          READ telemetryLRSSI                                         NOTIFY telemetryLRSSIChanged)
    Q_PROPERTY(unsigned int         telemetryRXErrors       READ telemetryRXErrors                                      NOTIFY telemetryRXErrorsChanged)
    Q_PROPERTY(unsigned int         telemetryFixed          READ telemetryFixed                                         NOTIFY telemetryFixedChanged)
    Q_PROPERTY(unsigned int         telemetryTXBuffer       READ telemetryTXBuffer                                      NOTIFY telemetryTXBufferChanged)
614 615
    Q_PROPERTY(int                  telemetryLNoise         READ telemetryLNoise                                        NOTIFY telemetryLNoiseChanged)
    Q_PROPERTY(int                  telemetryRNoise         READ telemetryRNoise                                        NOTIFY telemetryRNoiseChanged)
616
    Q_PROPERTY(QVariantList         toolBarIndicators       READ toolBarIndicators                                      NOTIFY toolBarIndicatorsChanged)
617
    Q_PROPERTY(QmlObjectListModel*  adsbVehicles            READ adsbVehicles                                           CONSTANT)
Don Gagne's avatar
Don Gagne committed
618
    Q_PROPERTY(bool              initialPlanRequestComplete READ initialPlanRequestComplete                             NOTIFY initialPlanRequestCompleteChanged)
Gus Grubba's avatar
Gus Grubba committed
619
    Q_PROPERTY(QVariantList         staticCameraList        READ staticCameraList                                       CONSTANT)
620
    Q_PROPERTY(QGCCameraManager*    dynamicCameras          READ dynamicCameras                                         NOTIFY dynamicCamerasChanged)
621
    Q_PROPERTY(QString              hobbsMeter              READ hobbsMeter                                             NOTIFY hobbsMeterChanged)
622
    Q_PROPERTY(bool                 vtolInFwdFlight         READ vtolInFwdFlight        WRITE setVtolInFwdFlight        NOTIFY vtolInFwdFlightChanged)
623
    Q_PROPERTY(bool                 highLatencyLink         READ highLatencyLink                                        NOTIFY highLatencyLinkChanged)
624
    Q_PROPERTY(bool                 supportsTerrainFrame    READ supportsTerrainFrame                                   NOTIFY firmwareTypeChanged)
625
    Q_PROPERTY(QString              priorityLinkName        READ priorityLinkName       WRITE setPriorityLinkByName     NOTIFY priorityLinkNameChanged)
626
    Q_PROPERTY(QVariantList         links                   READ links                                                  NOTIFY linksChanged)
627
    Q_PROPERTY(LinkInterface*       priorityLink            READ priorityLink                                           NOTIFY priorityLinkNameChanged)
628 629 630 631
    Q_PROPERTY(quint64              mavlinkSentCount        READ mavlinkSentCount                                       NOTIFY mavlinkStatusChanged)
    Q_PROPERTY(quint64              mavlinkReceivedCount    READ mavlinkReceivedCount                                   NOTIFY mavlinkStatusChanged)
    Q_PROPERTY(quint64              mavlinkLossCount        READ mavlinkLossCount                                       NOTIFY mavlinkStatusChanged)
    Q_PROPERTY(float                mavlinkLossPercent      READ mavlinkLossPercent                                     NOTIFY mavlinkStatusChanged)
632

633 634 635 636 637 638 639
    // Vehicle state used for guided control
    Q_PROPERTY(bool flying                  READ flying NOTIFY flyingChanged)                               ///< Vehicle is flying
    Q_PROPERTY(bool landing                 READ landing NOTIFY landingChanged)                             ///< Vehicle is in landing pattern (DO_LAND_START)
    Q_PROPERTY(bool guidedMode              READ guidedMode WRITE setGuidedMode NOTIFY guidedModeChanged)   ///< Vehicle is in Guided mode and can respond to guided commands
    Q_PROPERTY(bool guidedModeSupported     READ guidedModeSupported CONSTANT)                              ///< Guided mode commands are supported by this vehicle
    Q_PROPERTY(bool pauseVehicleSupported   READ pauseVehicleSupported CONSTANT)                            ///< Pause vehicle command is supported
    Q_PROPERTY(bool orbitModeSupported      READ orbitModeSupported CONSTANT)                               ///< Orbit mode is supported by this vehicle
640
    Q_PROPERTY(bool takeoffVehicleSupported READ takeoffVehicleSupported CONSTANT)                          ///< Guided takeoff supported
641

642 643
    Q_PROPERTY(ParameterManager* parameterManager READ parameterManager CONSTANT)

Don Gagne's avatar
Don Gagne committed
644 645 646 647 648
    // FactGroup object model properties

    Q_PROPERTY(Fact* roll               READ roll               CONSTANT)
    Q_PROPERTY(Fact* pitch              READ pitch              CONSTANT)
    Q_PROPERTY(Fact* heading            READ heading            CONSTANT)
DonLakeFlyer's avatar
DonLakeFlyer committed
649 650 651
    Q_PROPERTY(Fact* rollRate           READ rollRate           CONSTANT)
    Q_PROPERTY(Fact* pitchRate          READ pitchRate          CONSTANT)
    Q_PROPERTY(Fact* yawRate            READ yawRate            CONSTANT)
Don Gagne's avatar
Don Gagne committed
652 653 654 655 656
    Q_PROPERTY(Fact* groundSpeed        READ groundSpeed        CONSTANT)
    Q_PROPERTY(Fact* airSpeed           READ airSpeed           CONSTANT)
    Q_PROPERTY(Fact* climbRate          READ climbRate          CONSTANT)
    Q_PROPERTY(Fact* altitudeRelative   READ altitudeRelative   CONSTANT)
    Q_PROPERTY(Fact* altitudeAMSL       READ altitudeAMSL       CONSTANT)
657
    Q_PROPERTY(Fact* flightDistance     READ flightDistance     CONSTANT)
658
    Q_PROPERTY(Fact* distanceToHome     READ distanceToHome     CONSTANT)
659
    Q_PROPERTY(Fact* distanceToGCS      READ distanceToGCS      CONSTANT)
660
    Q_PROPERTY(Fact* hobbs              READ hobbs              CONSTANT)
Don Gagne's avatar
Don Gagne committed
661

662 663 664 665 666 667 668 669 670
    Q_PROPERTY(FactGroup* gps               READ gpsFactGroup               CONSTANT)
    Q_PROPERTY(FactGroup* battery           READ battery1FactGroup          CONSTANT)
    Q_PROPERTY(FactGroup* battery2          READ battery2FactGroup          CONSTANT)
    Q_PROPERTY(FactGroup* wind              READ windFactGroup              CONSTANT)
    Q_PROPERTY(FactGroup* vibration         READ vibrationFactGroup         CONSTANT)
    Q_PROPERTY(FactGroup* temperature       READ temperatureFactGroup       CONSTANT)
    Q_PROPERTY(FactGroup* clock             READ clockFactGroup             CONSTANT)
    Q_PROPERTY(FactGroup* setpoint          READ setpointFactGroup          CONSTANT)
    Q_PROPERTY(FactGroup* estimatorStatus   READ estimatorStatusFactGroup   CONSTANT)
Don Gagne's avatar
Don Gagne committed
671

672 673 674 675 676 677 678 679 680
    Q_PROPERTY(int      firmwareMajorVersion        READ firmwareMajorVersion       NOTIFY firmwareVersionChanged)
    Q_PROPERTY(int      firmwareMinorVersion        READ firmwareMinorVersion       NOTIFY firmwareVersionChanged)
    Q_PROPERTY(int      firmwarePatchVersion        READ firmwarePatchVersion       NOTIFY firmwareVersionChanged)
    Q_PROPERTY(int      firmwareVersionType         READ firmwareVersionType        NOTIFY firmwareVersionChanged)
    Q_PROPERTY(QString  firmwareVersionTypeString   READ firmwareVersionTypeString  NOTIFY firmwareVersionChanged)
    Q_PROPERTY(int      firmwareCustomMajorVersion  READ firmwareCustomMajorVersion NOTIFY firmwareCustomVersionChanged)
    Q_PROPERTY(int      firmwareCustomMinorVersion  READ firmwareCustomMinorVersion NOTIFY firmwareCustomVersionChanged)
    Q_PROPERTY(int      firmwareCustomPatchVersion  READ firmwareCustomPatchVersion NOTIFY firmwareCustomVersionChanged)
    Q_PROPERTY(QString  gitHash                     READ gitHash                    NOTIFY gitHashChanged)
Gus Grubba's avatar
Gus Grubba committed
681 682
    Q_PROPERTY(quint64  vehicleUID                  READ vehicleUID                 NOTIFY vehicleUIDChanged)
    Q_PROPERTY(QString  vehicleUIDStr               READ vehicleUIDStr              NOTIFY vehicleUIDChanged)
683

684 685
    /// Resets link status counters
    Q_INVOKABLE void resetCounters  ();
686 687 688 689 690 691 692

    /// Returns the number of buttons which are reserved for firmware use in the MANUAL_CONTROL mavlink
    /// message. For example PX4 Flight Stack reserves the first 8 buttons to simulate rc switches.
    /// The remainder can be assigned to Vehicle actions.
    /// @return -1: reserver all buttons, >0 number of buttons to reserve
    Q_PROPERTY(int manualControlReservedButtonCount READ manualControlReservedButtonCount CONSTANT)

dogmaphobic's avatar
dogmaphobic committed
693 694 695
    // Called when the message drop-down is invoked to clear current count
    Q_INVOKABLE void        resetMessages();

Don Gagne's avatar
Don Gagne committed
696
    Q_INVOKABLE void virtualTabletJoystickValue(double roll, double pitch, double yaw, double thrust);
Don Gagne's avatar
Don Gagne committed
697
    Q_INVOKABLE void disconnectInactiveVehicle(void);
Don Gagne's avatar
Don Gagne committed
698

Don Gagne's avatar
Don Gagne committed
699 700 701 702 703 704 705
    /// Command vehicle to return to launch
    Q_INVOKABLE void guidedModeRTL(void);

    /// Command vehicle to land at current location
    Q_INVOKABLE void guidedModeLand(void);

    /// Command vehicle to takeoff from current location
706
    Q_INVOKABLE void guidedModeTakeoff(double altitudeRelative);
Don Gagne's avatar
Don Gagne committed
707

708 709 710
    /// @return The minimum takeoff altitude (relative) for guided takeoff.
    Q_INVOKABLE double minimumTakeoffAltitude(void);

Don Gagne's avatar
Don Gagne committed
711 712 713
    /// Command vehicle to move to specified location (altitude is included and relative)
    Q_INVOKABLE void guidedModeGotoLocation(const QGeoCoordinate& gotoCoord);

714 715 716
    /// Command vehicle to change altitude
    ///     @param altitudeChange If > 0, go up by amount specified, if < 0, go down by amount specified
    Q_INVOKABLE void guidedModeChangeAltitude(double altitudeChange);
Don Gagne's avatar
Don Gagne committed
717

718
    /// Command vehicle to orbit given center point
DonLakeFlyer's avatar
DonLakeFlyer committed
719
    ///     @param centerCoord Orit around this point
720
    ///     @param radius Distance from vehicle to centerCoord
DonLakeFlyer's avatar
DonLakeFlyer committed
721 722
    ///     @param amslAltitude Desired vehicle altitude
    Q_INVOKABLE void guidedModeOrbit(const QGeoCoordinate& centerCoord, double radius, double amslAltitude);
723

Don Gagne's avatar
Don Gagne committed
724 725 726 727 728 729 730
    /// Command vehicle to pause at current location. If vehicle supports guide mode, vehicle will be left
    /// in guided mode after pause.
    Q_INVOKABLE void pauseVehicle(void);

    /// Command vehicle to kill all motors no matter what state
    Q_INVOKABLE void emergencyStop(void);

731
    /// Command vehicle to abort landing
732
    Q_INVOKABLE void abortLanding(double climbOutAltitude);
733

734 735
    Q_INVOKABLE void startMission(void);

736 737 738
    /// Alter the current mission item on the vehicle
    Q_INVOKABLE void setCurrentMissionSequence(int seq);

739 740 741
    /// Reboot vehicle
    Q_INVOKABLE void rebootVehicle();

dogmaphobic's avatar
dogmaphobic committed
742 743 744
    /// Clear Messages
    Q_INVOKABLE void clearMessages();

Don Gagne's avatar
Don Gagne committed
745
    Q_INVOKABLE void triggerCamera(void);
Don Gagne's avatar
Don Gagne committed
746
    Q_INVOKABLE void sendPlan(QString planFile);
Don Gagne's avatar
Don Gagne committed
747

Don Gagne's avatar
Don Gagne committed
748 749
#if 0
    // Temporarily removed, waiting for new command implementation
Don Gagne's avatar
Don Gagne committed
750 751 752 753 754
    /// Test motor
    ///     @param motor Motor number, 1-based
    ///     @param percent 0-no power, 100-full power
    ///     @param timeoutSecs Number of seconds for motor to run
    Q_INVOKABLE void motorTest(int motor, int percent, int timeoutSecs);
Don Gagne's avatar
Don Gagne committed
755
#endif
Don Gagne's avatar
Don Gagne committed
756

757 758 759 760
    bool guidedModeSupported    (void) const;
    bool pauseVehicleSupported  (void) const;
    bool orbitModeSupported     (void) const;
    bool takeoffVehicleSupported(void) const;
Don Gagne's avatar
Don Gagne committed
761

762
    // Property accessors
Don Gagne's avatar
Don Gagne committed
763

764
    QGeoCoordinate coordinate(void) { return _coordinate; }
dogmaphobic's avatar
dogmaphobic committed
765

766
    typedef enum {
767
        JoystickModeRC,         ///< Joystick emulates an RC Transmitter
768 769 770 771 772 773
        JoystickModeAttitude,
        JoystickModePosition,
        JoystickModeForce,
        JoystickModeVelocity,
        JoystickModeMax
    } JoystickMode_t;
dogmaphobic's avatar
dogmaphobic committed
774

775 776
    int joystickMode(void);
    void setJoystickMode(int mode);
dogmaphobic's avatar
dogmaphobic committed
777

778 779
    /// List of joystick mode names
    QStringList joystickModes(void);
dogmaphobic's avatar
dogmaphobic committed
780

781 782
    bool joystickEnabled(void);
    void setJoystickEnabled(bool enabled);
dogmaphobic's avatar
dogmaphobic committed
783

784 785 786
    // Is vehicle active with respect to current active vehicle in QGC
    bool active(void);
    void setActive(bool active);
dogmaphobic's avatar
dogmaphobic committed
787

788 789
    // Property accesors
    int id(void) { return _id; }
790 791
    MAV_AUTOPILOT firmwareType(void) const { return _firmwareType; }
    MAV_TYPE vehicleType(void) const { return _vehicleType; }
792
    Q_INVOKABLE QString vehicleTypeName(void) const;
dogmaphobic's avatar
dogmaphobic committed
793

Patrick José Pereira's avatar
Patrick José Pereira committed
794
    /// Returns the highest quality link available to the Vehicle. If you need to hold a reference to this link use
795 796
    /// LinkManager::sharedLinkInterfaceForGet to get QSharedPointer for link.
    LinkInterface* priorityLink(void) { return _priorityLink.data(); }
797 798 799 800 801

    /// Sends a message to the specified link
    /// @return true: message sent, false: Link no longer connected
    bool sendMessageOnLink(LinkInterface* link, mavlink_message_t message);

802 803 804
    /// Sends the specified messages multiple times to the vehicle in order to attempt to
    /// guarantee that it makes it to the vehicle.
    void sendMessageMultiple(mavlink_message_t message);
dogmaphobic's avatar
dogmaphobic committed
805

806 807
    /// Provides access to uas from vehicle. Temporary workaround until UAS is fully phased out.
    UAS* uas(void) { return _uas; }
dogmaphobic's avatar
dogmaphobic committed
808

809 810
    /// Provides access to uas from vehicle. Temporary workaround until AutoPilotPlugin is fully phased out.
    AutoPilotPlugin* autopilotPlugin(void) { return _autopilotPlugin; }
dogmaphobic's avatar
dogmaphobic committed
811

Don Gagne's avatar
Don Gagne committed
812 813
    /// Provides access to the Firmware Plugin for this Vehicle
    FirmwarePlugin* firmwarePlugin(void) { return _firmwarePlugin; }
dogmaphobic's avatar
dogmaphobic committed
814

815
    int manualControlReservedButtonCount(void);
dogmaphobic's avatar
dogmaphobic committed
816

817 818 819
    MissionManager*     missionManager(void)    { return _missionManager; }
    GeoFenceManager*    geoFenceManager(void)   { return _geoFenceManager; }
    RallyPointManager*  rallyPointManager(void) { return _rallyPointManager; }
dogmaphobic's avatar
dogmaphobic committed
820

821
    QGeoCoordinate homePosition(void);
dogmaphobic's avatar
dogmaphobic committed
822

Don Gagne's avatar
Don Gagne committed
823 824 825 826 827
    bool armed(void) { return _armed; }
    void setArmed(bool armed);

    bool flightModeSetAvailable(void);
    QStringList flightModes(void);
Don Gagne's avatar
Don Gagne committed
828
    QString flightMode(void) const;
Don Gagne's avatar
Don Gagne committed
829 830
    void setFlightMode(const QString& flightMode);

831
    QString priorityLinkName(void) const;
832
    QVariantList links(void) const;
833 834
    void setPriorityLinkByName(const QString& priorityLinkName);

Don Gagne's avatar
Don Gagne committed
835 836
    bool hilMode(void);
    void setHilMode(bool hilMode);
dogmaphobic's avatar
dogmaphobic committed
837

838 839
    bool fixedWing(void) const;
    bool multiRotor(void) const;
Don Gagne's avatar
Don Gagne committed
840
    bool vtol(void) const;
Don Gagne's avatar
Don Gagne committed
841
    bool rover(void) const;
842
    bool sub(void) const;
843

844 845 846 847 848 849
    bool supportsThrottleModeCenterZero (void) const;
    bool supportsNegativeThrust         (void) const;
    bool supportsRadio                  (void) const;
    bool supportsJSButton               (void) const;
    bool supportsMotorInterference      (void) const;
    bool supportsTerrainFrame           (void) const;
850

Don Gagne's avatar
Don Gagne committed
851 852
    void setGuidedMode(bool guidedMode);

Don Gagne's avatar
Don Gagne committed
853 854 855
    QString prearmError(void) const { return _prearmError; }
    void setPrearmError(const QString& prearmError);

856
    QmlObjectListModel* trajectoryPoints(void) { return &_mapTrajectoryList; }
857
    QmlObjectListModel* cameraTriggerPoints(void) { return &_cameraTriggerPoints; }
858
    QmlObjectListModel* adsbVehicles(void) { return &_adsbVehicles; }
dogmaphobic's avatar
dogmaphobic committed
859 860 861

    int  flowImageIndex() { return _flowImageIndex; }

862 863 864 865
    //-- Mavlink Logging
    void startMavlinkLog();
    void stopMavlinkLog();

866 867 868
    /// Requests the specified data stream from the vehicle
    ///     @param stream Stream which is being requested
    ///     @param rate Rate at which to send stream in Hz
869 870
    ///     @param sendMultiple Send multiple time to guarantee Vehicle reception
    void requestDataStream(MAV_DATA_STREAM stream, uint16_t rate, bool sendMultiple = true);
dogmaphobic's avatar
dogmaphobic committed
871

872 873 874 875 876 877
    typedef enum {
        MessageNone,
        MessageNormal,
        MessageWarning,
        MessageError
    } MessageType_t;
dogmaphobic's avatar
dogmaphobic committed
878

879 880 881 882 883 884 885 886 887 888 889 890 891 892 893 894 895 896 897 898 899 900
    bool            messageTypeNone         () { return _currentMessageType == MessageNone; }
    bool            messageTypeNormal       () { return _currentMessageType == MessageNormal; }
    bool            messageTypeWarning      () { return _currentMessageType == MessageWarning; }
    bool            messageTypeError        () { return _currentMessageType == MessageError; }
    int             newMessageCount         () { return _currentMessageCount; }
    int             messageCount            () { return _messageCount; }
    QString         formatedMessages        ();
    QString         formatedMessage         () { return _formatedMessage; }
    QString         latestError             () { return _latestError; }
    float           latitude                () { return _coordinate.latitude(); }
    float           longitude               () { return _coordinate.longitude(); }
    bool            mavPresent              () { return _mav != NULL; }
    int             rcRSSI                  () { return _rcRSSI; }
    bool            px4Firmware             () const { return _firmwareType == MAV_AUTOPILOT_PX4; }
    bool            apmFirmware             () const { return _firmwareType == MAV_AUTOPILOT_ARDUPILOTMEGA; }
    bool            genericFirmware         () const { return !px4Firmware() && !apmFirmware(); }
    bool            connectionLost          () const { return _connectionLost; }
    bool            connectionLostEnabled   () const { return _connectionLostEnabled; }
    uint            messagesReceived        () { return _messagesReceived; }
    uint            messagesSent            () { return _messagesSent; }
    uint            messagesLost            () { return _messagesLost; }
    bool            flying                  () const { return _flying; }
901
    bool            landing                 () const { return _landing; }
902
    bool            guidedMode              () const;
903
    bool            vtolInFwdFlight         () const { return _vtolInFwdFlight; }
904 905 906
    uint8_t         baseMode                () const { return _base_mode; }
    uint32_t        customMode              () const { return _custom_mode; }
    bool            isOfflineEditingVehicle () const { return _offlineEditingVehicle; }
907 908
    QString         brandImageIndoor        () const;
    QString         brandImageOutdoor       () const;
909
    QStringList     unhealthySensors        () const;
910 911 912
    int             sensorsPresentBits      () const { return _onboardControlSensorsPresent; }
    int             sensorsEnabledBits      () const { return _onboardControlSensorsEnabled; }
    int             sensorsHealthBits       () const { return _onboardControlSensorsHealth; }
913
    int             sensorsUnhealthyBits    () const { return _onboardControlSensorsUnhealthy; }
914
    QString         missionFlightMode       () const;
915
    QString         pauseFlightMode         () const;
916
    QString         rtlFlightMode           () const;
917
    QString         landFlightMode          () const;
918
    QString         takeControlFlightMode   () const;
DonLakeFlyer's avatar
DonLakeFlyer committed
919 920
    double          defaultCruiseSpeed      () const { return _defaultCruiseSpeed; }
    double          defaultHoverSpeed       () const { return _defaultHoverSpeed; }
921
    QString         firmwareTypeString      () const;
Gus Grubba's avatar
Gus Grubba committed
922 923 924 925 926 927
    QString         vehicleTypeString       () const;
    int             telemetryRRSSI          () { return _telemetryRRSSI; }
    int             telemetryLRSSI          () { return _telemetryLRSSI; }
    unsigned int    telemetryRXErrors       () { return _telemetryRXErrors; }
    unsigned int    telemetryFixed          () { return _telemetryFixed; }
    unsigned int    telemetryTXBuffer       () { return _telemetryTXBuffer; }
928 929
    int             telemetryLNoise         () { return _telemetryLNoise; }
    int             telemetryRNoise         () { return _telemetryRNoise; }
930
    bool            autoDisarm              ();
931
    bool            highLatencyLink         () const { return _highLatencyLink; }
932 933 934
    /// Get the maximum MAVLink protocol version supported
    /// @return the maximum version
    unsigned        maxProtoVersion         () const { return _maxProtoVersion; }
935

Don Gagne's avatar
Don Gagne committed
936 937
    Fact* roll              (void) { return &_rollFact; }
    Fact* pitch             (void) { return &_pitchFact; }
DonLakeFlyer's avatar
DonLakeFlyer committed
938 939 940 941
    Fact* heading           (void) { return &_headingFact; }
    Fact* rollRate          (void) { return &_rollRateFact; }
    Fact* pitchRate         (void) { return &_pitchRateFact; }
    Fact* yawRate           (void) { return &_yawRateFact; }
Don Gagne's avatar
Don Gagne committed
942 943 944 945 946
    Fact* airSpeed          (void) { return &_airSpeedFact; }
    Fact* groundSpeed       (void) { return &_groundSpeedFact; }
    Fact* climbRate         (void) { return &_climbRateFact; }
    Fact* altitudeRelative  (void) { return &_altitudeRelativeFact; }
    Fact* altitudeAMSL      (void) { return &_altitudeAMSLFact; }
947
    Fact* flightDistance    (void) { return &_flightDistanceFact; }
948
    Fact* distanceToHome    (void) { return &_distanceToHomeFact; }
949
    Fact* distanceToGCS     (void) { return &_distanceToGCSFact; }
950
    Fact* hobbs             (void) { return &_hobbsFact; }
Don Gagne's avatar
Don Gagne committed
951

952
    FactGroup* gpsFactGroup             (void) { return &_gpsFactGroup; }
DonLakeFlyer's avatar
DonLakeFlyer committed
953 954
    FactGroup* battery1FactGroup        (void) { return &_battery1FactGroup; }
    FactGroup* battery2FactGroup        (void) { return &_battery2FactGroup; }
955 956 957 958 959 960
    FactGroup* windFactGroup            (void) { return &_windFactGroup; }
    FactGroup* vibrationFactGroup       (void) { return &_vibrationFactGroup; }
    FactGroup* temperatureFactGroup     (void) { return &_temperatureFactGroup; }
    FactGroup* clockFactGroup           (void) { return &_clockFactGroup; }
    FactGroup* setpointFactGroup        (void) { return &_setpointFactGroup; }
    FactGroup* distanceSensorFactGroup  (void) { return &_distanceSensorFactGroup; }
961
    FactGroup* estimatorStatusFactGroup (void) { return &_estimatorStatusFactGroup; }
Don Gagne's avatar
Don Gagne committed
962

963
    void setConnectionLostEnabled(bool connectionLostEnabled);
964

965 966
    ParameterManager* parameterManager(void) { return _parameterManager; }
    ParameterManager* parameterManager(void) const { return _parameterManager; }
dogmaphobic's avatar
dogmaphobic committed
967

Don Gagne's avatar
Don Gagne committed
968 969
    static const int cMaxRcChannels = 18;

Don Gagne's avatar
Don Gagne committed
970
    bool containsLink(LinkInterface* link) { return _links.contains(link); }
971 972 973 974 975 976

    /// Sends the specified MAV_CMD to the vehicle. If no Ack is received command will be retried. If a sendMavCommand is already in progress
    /// the command will be queued and sent when the previous command completes.
    ///     @param component Component to send to
    ///     @param command MAV_CMD to send
    ///     @param showError true: Display error to user if command failed, false:  no error shown
DonLakeFlyer's avatar
DonLakeFlyer committed
977
    /// Signals: mavCommandResult on success or failure
978
    void sendMavCommand(int component, MAV_CMD command, bool showError, float param1 = 0.0f, float param2 = 0.0f, float param3 = 0.0f, float param4 = 0.0f, float param5 = 0.0f, float param6 = 0.0f, float param7 = 0.0f);
979
    void sendMavCommandInt(int component, MAV_CMD command, MAV_FRAME frame, bool showError, float param1, float param2, float param3, float param4, double param5, double param6, float param7);
Don Gagne's avatar
Don Gagne committed
980

981 982 983 984
    /// Same as sendMavCommand but available from Qml.
    Q_INVOKABLE void sendCommand(int component, int command, bool showError, double param1 = 0.0f, double param2 = 0.0f, double param3 = 0.0f, double param4 = 0.0f, double param5 = 0.0f, double param6 = 0.0f, double param7 = 0.0f)
        { sendMavCommand(component, (MAV_CMD)command, showError, param1, param2, param3, param4, param5, param6, param7); }

Don Gagne's avatar
Don Gagne committed
985 986 987
    int firmwareMajorVersion(void) const { return _firmwareMajorVersion; }
    int firmwareMinorVersion(void) const { return _firmwareMinorVersion; }
    int firmwarePatchVersion(void) const { return _firmwarePatchVersion; }
988
    int firmwareVersionType(void) const { return _firmwareVersionType; }
989 990 991
    int firmwareCustomMajorVersion(void) const { return _firmwareCustomMajorVersion; }
    int firmwareCustomMinorVersion(void) const { return _firmwareCustomMinorVersion; }
    int firmwareCustomPatchVersion(void) const { return _firmwareCustomPatchVersion; }
992 993
    QString firmwareVersionTypeString(void) const;
    void setFirmwareVersion(int majorVersion, int minorVersion, int patchVersion, FIRMWARE_VERSION_TYPE versionType = FIRMWARE_VERSION_TYPE_OFFICIAL);
994
    void setFirmwareCustomVersion(int majorVersion, int minorVersion, int patchVersion);
995
    static const int versionNotSetValue = -1;
Don Gagne's avatar
Don Gagne committed
996

997
    QString gitHash(void) const { return _gitHash; }
Gus Grubba's avatar
Gus Grubba committed
998 999
    quint64 vehicleUID(void) const { return _uid; }
    QString vehicleUIDStr();
1000

1001 1002 1003
    bool soloFirmware(void) const { return _soloFirmware; }
    void setSoloFirmware(bool soloFirmware);

1004 1005 1006 1007
    int defaultComponentId(void) { return _defaultComponentId; }

    /// Sets the default component id for an offline editing vehicle
    void setOfflineEditingDefaultComponentId(int defaultComponentId);
Don Gagne's avatar
Don Gagne committed
1008

Don Gagne's avatar
Don Gagne committed
1009 1010 1011 1012 1013 1014 1015 1016 1017
    /// @return -1 = Unknown, Number of motors on vehicle
    int motorCount(void);

    /// @return true: Motors are coaxial like an X8 config, false: Quadcopter for example
    bool coaxialMotors(void);

    /// @return true: X confiuration, false: Plus configuration
    bool xConfigMotors(void);

1018 1019 1020 1021 1022 1023 1024
    /// @return Firmware plugin instance data associated with this Vehicle
    QObject* firmwarePluginInstanceData(void) { return _firmwarePluginInstanceData; }

    /// Sets the firmware plugin instance data associated with this Vehicle. This object will be parented to the Vehicle
    /// and destroyed when the vehicle goes away.
    void setFirmwarePluginInstanceData(QObject* firmwarePluginInstanceData);

1025 1026 1027 1028
    QString vehicleImageOpaque  () const;
    QString vehicleImageOutline () const;
    QString vehicleImageCompass () const;

1029
    const QVariantList&         toolBarIndicators   ();
Gus Grubba's avatar
Gus Grubba committed
1030
    const QVariantList&         staticCameraList    (void) const;
1031

1032 1033
    bool capabilitiesKnown      (void) const { return _vehicleCapabilitiesKnown; }
    uint64_t capabilityBits     (void) const { return _capabilityBits; }    // Change signalled by capabilityBitsChanged
1034

1035
    QGCCameraManager*           dynamicCameras      () { return _cameras; }
1036
    QString                     hobbsMeter          ();
1037

1038 1039 1040
    /// @true: When flying a mission the vehicle is always facing towards the next waypoint
    bool vehicleYawsToNextWaypointInMission(void) const;

DonLakeFlyer's avatar
DonLakeFlyer committed
1041 1042 1043 1044
    /// The vehicle is responsible for making the initial request for the Plan.
    /// @return: true: initial request is complete, false: initial request is still in progress;
    bool initialPlanRequestComplete(void) const { return _initialPlanRequestComplete; }

Don Gagne's avatar
Don Gagne committed
1045
    void forceInitialPlanRequestComplete(void);
1046

1047 1048
    void _setFlying(bool flying);
    void _setLanding(bool landing);
1049
    void setVtolInFwdFlight(bool vtolInFwdFlight);
DonLakeFlyer's avatar
DonLakeFlyer committed
1050
    void _setHomePosition(QGeoCoordinate& homeCoord);
1051
    void _setMaxProtoVersion (unsigned version);
DonLakeFlyer's avatar
DonLakeFlyer committed
1052

1053 1054 1055
    /// Vehicle is about to be deleted
    void prepareDelete();

1056 1057 1058 1059 1060
    quint64     mavlinkSentCount        () { return _mavlinkSentCount; }        /// Calculated total number of messages sent to us
    quint64     mavlinkReceivedCount    () { return _mavlinkReceivedCount; }    /// Total number of sucessful messages received
    quint64     mavlinkLossCount        () { return _mavlinkLossCount; }        /// Total number of lost messages
    float       mavlinkLossPercent      () { return _mavlinkLossPercent; }      /// Running loss rate

1061
signals:
Don Gagne's avatar
Don Gagne committed
1062
    void allLinksInactive(Vehicle* vehicle);
1063
    void coordinateChanged(QGeoCoordinate coordinate);
1064
    void joystickModeChanged(int mode);
1065 1066
    void joystickEnabledChanged(bool enabled);
    void activeChanged(bool active);
Don Gagne's avatar
Don Gagne committed
1067
    void mavlinkMessageReceived(const mavlink_message_t& message);
1068
    void homePositionChanged(const QGeoCoordinate& homePosition);
Don Gagne's avatar
Don Gagne committed
1069 1070 1071
    void armedChanged(bool armed);
    void flightModeChanged(const QString& flightMode);
    void hilModeChanged(bool hilMode);
1072 1073
    /** @brief HIL actuator controls (replaces HIL controls) */
    void hilActuatorControlsChanged(quint64 time, quint64 flags, float ctl_0, float ctl_1, float ctl_2, float ctl_3, float ctl_4, float ctl_5, float ctl_6, float ctl_7, float ctl_8, float ctl_9, float ctl_10, float ctl_11, float ctl_12, float ctl_13, float ctl_14, float ctl_15, quint8 mode);
1074 1075
    void connectionLostChanged(bool connectionLost);
    void connectionLostEnabledChanged(bool connectionLostEnabled);
Don Gagne's avatar
Don Gagne committed
1076
    void autoDisconnectChanged(bool autoDisconnectChanged);
Don Gagne's avatar
Don Gagne committed
1077
    void flyingChanged(bool flying);
1078
    void landingChanged(bool landing);
Don Gagne's avatar
Don Gagne committed
1079
    void guidedModeChanged(bool guidedMode);
1080
    void vtolInFwdFlightChanged(bool vtolInFwdFlight);
Don Gagne's avatar
Don Gagne committed
1081
    void prearmErrorChanged(const QString& prearmError);
1082
    void soloFirmwareChanged(bool soloFirmware);
1083
    void unhealthySensorsChanged(void);
DonLakeFlyer's avatar
DonLakeFlyer committed
1084 1085
    void defaultCruiseSpeedChanged(double cruiseSpeed);
    void defaultHoverSpeedChanged(double hoverSpeed);
1086 1087
    void firmwareTypeChanged(void);
    void vehicleTypeChanged(void);
1088
    void dynamicCamerasChanged();
1089
    void hobbsMeterChanged();
1090
    void capabilitiesKnownChanged(bool capabilitiesKnown);
Don Gagne's avatar
Don Gagne committed
1091
    void initialPlanRequestCompleteChanged(bool initialPlanRequestComplete);
1092
    void capabilityBitsChanged(uint64_t capabilityBits);
1093
    void toolBarIndicatorsChanged(void);
1094
    void highLatencyLinkChanged(bool highLatencyLink);
1095
    void priorityLinkNameChanged(const QString& priorityLinkName);
1096 1097
    void linksChanged(void);
    void linksPropertiesChanged(void);
1098
    void textMessageReceived(int uasid, int componentid, int severity, QString text);
dogmaphobic's avatar
dogmaphobic committed
1099

1100 1101 1102 1103
    void messagesReceivedChanged    ();
    void messagesSentChanged        ();
    void messagesLostChanged        ();

1104
    /// Used internally to move sendMessage call to main thread
1105
    void _sendMessageOnLinkOnThread(LinkInterface* link, mavlink_message_t message);
dogmaphobic's avatar
dogmaphobic committed
1106

Gus Grubba's avatar
Gus Grubba committed
1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117 1118 1119 1120 1121
    void messageTypeChanged         ();
    void newMessageCountChanged     ();
    void messageCountChanged        ();
    void formatedMessagesChanged    ();
    void formatedMessageChanged     ();
    void latestErrorChanged         ();
    void longitudeChanged           ();
    void currentConfigChanged       ();
    void flowImageIndexChanged      ();
    void rcRSSIChanged              (int rcRSSI);
    void telemetryRRSSIChanged      (int value);
    void telemetryLRSSIChanged      (int value);
    void telemetryRXErrorsChanged   (unsigned int value);
    void telemetryFixedChanged      (unsigned int value);
    void telemetryTXBufferChanged   (unsigned int value);
1122 1123
    void telemetryLNoiseChanged     (int value);
    void telemetryRNoiseChanged     (int value);
1124
    void autoDisarmChanged          (void);
1125
    void flightModesChanged         (void);
1126 1127 1128
    void sensorsPresentBitsChanged  (int sensorsPresentBits);
    void sensorsEnabledBitsChanged  (int sensorsEnabledBits);
    void sensorsHealthBitsChanged   (int sensorsHealthBits);
1129
    void sensorsUnhealthyBitsChanged(int sensorsUnhealthyBits);
dogmaphobic's avatar
dogmaphobic committed
1130

1131 1132
    void firmwareVersionChanged(void);
    void firmwareCustomVersionChanged(void);
1133
    void gitHashChanged(QString hash);
Gus Grubba's avatar
Gus Grubba committed
1134
    void vehicleUIDChanged();
1135

Don Gagne's avatar
Don Gagne committed
1136 1137 1138 1139 1140 1141 1142 1143
    /// New RC channel values
    ///     @param channelCount Number of available channels, cMaxRcChannels max
    ///     @param pwmValues -1 signals channel not available
    void rcChannelsChanged(int channelCount, int pwmValues[cMaxRcChannels]);

    /// Remote control RSSI changed  (0% - 100%)
    void remoteControlRSSIChanged(uint8_t rssi);

1144 1145 1146 1147 1148
    void mavlinkRawImu(mavlink_message_t message);
    void mavlinkScaledImu1(mavlink_message_t message);
    void mavlinkScaledImu2(mavlink_message_t message);
    void mavlinkScaledImu3(mavlink_message_t message);

1149
    // Mavlink Log Download
Gus Grubba's avatar
Gus Grubba committed
1150
    void mavlinkLogData (Vehicle* vehicle, uint8_t target_system, uint8_t target_component, uint16_t sequence, uint8_t first_message, QByteArray data, bool acked);
1151

1152 1153 1154 1155 1156 1157
    /// Signalled in response to usage of sendMavCommand
    ///     @param vehicleId Vehicle which command was sent to
    ///     @param component Component which command was sent to
    ///     @param command MAV_CMD Command which was sent
    ///     @param result MAV_RESULT returned in ack
    ///     @param noResponseFromVehicle true: vehicle did not respond to command, false: vehicle responsed, MAV_RESULT in result
1158
    void mavCommandResult(int vehicleId, int component, int command, int result, bool noReponseFromVehicle);
1159

1160
    // MAVlink Serial Data
1161 1162
    void mavlinkSerialControl(uint8_t device, uint8_t flags, uint16_t timeout, uint32_t baudrate, QByteArray data);

1163 1164
    // MAVLink protocol version
    void requestProtocolVersion(unsigned version);
1165
    void mavlinkStatusChanged();
1166

1167 1168
private slots:
    void _mavlinkMessageReceived(LinkInterface* link, mavlink_message_t message);
Don Gagne's avatar
Don Gagne committed
1169
    void _linkInactiveOrDeleted(LinkInterface* link);
1170
    void _sendMessageOnLink(LinkInterface* link, mavlink_message_t message);
1171
    void _sendMessageMultipleNext(void);
1172
    void _addNewMapTrajectoryPoint(void);
1173
    void _parametersReady(bool parametersReady);
Don Gagne's avatar
Don Gagne committed
1174
    void _remoteControlRSSIChanged(uint8_t rssi);
Don Gagne's avatar
Don Gagne committed
1175
    void _handleFlightModeChanged(const QString& flightMode);
1176
    void _announceArmedChanged(bool armed);
1177 1178 1179 1180
    void _offlineFirmwareTypeSettingChanged(QVariant value);
    void _offlineVehicleTypeSettingChanged(QVariant value);
    void _offlineCruiseSpeedSettingChanged(QVariant value);
    void _offlineHoverSpeedSettingChanged(QVariant value);
1181
    void _updateHighLatencyLink(bool sendCommand = true);
1182

1183
    void _handleTextMessage                 (int newCount);
dogmaphobic's avatar
dogmaphobic committed
1184
    void _handletextMessageReceived         (UASMessage* message);
dogmaphobic's avatar
dogmaphobic committed
1185 1186
    /** @brief A new camera image has arrived */
    void _imageReady                        (UASInterface* uas);
Don Gagne's avatar
Don Gagne committed
1187
    void _prearmErrorTimeout(void);
DonLakeFlyer's avatar
DonLakeFlyer committed
1188 1189 1190
    void _missionLoadComplete(void);
    void _geoFenceLoadComplete(void);
    void _rallyPointLoadComplete(void);
1191
    void _sendMavCommandAgain(void);
1192 1193
    void _clearTrajectoryPoints(void);
    void _clearCameraTriggerPoints(void);
1194
    void _updateDistanceToHome(void);
1195
    void _updateDistanceToGCS(void);
1196 1197
    void _updateHobbsMeter(void);
    void _vehicleParamLoaded(bool ready);
1198
    void _sendQGCTimeToVehicle(void);
1199
    void _mavlinkMessageStatus(int uasId, uint64_t totalSent, uint64_t totalReceived, uint64_t totalLoss, float lossPercent);
Jacob Walser's avatar
Jacob Walser committed
1200

Gus Grubba's avatar
Gus Grubba committed
1201 1202
    void _trafficUpdate         (bool alert, QString traffic_id, QString vehicle_id, QGeoCoordinate location, float heading);
    void _adsbTimerTimeout      ();
1203

1204 1205 1206
private:
    bool _containsLink(LinkInterface* link);
    void _addLink(LinkInterface* link);
1207 1208
    void _loadSettings(void);
    void _saveSettings(void);
1209
    void _startJoystick(bool start);
DonLakeFlyer's avatar
DonLakeFlyer committed
1210
    void _handlePing(LinkInterface* link, mavlink_message_t& message);
Don Gagne's avatar
Don Gagne committed
1211 1212
    void _handleHomePosition(mavlink_message_t& message);
    void _handleHeartbeat(mavlink_message_t& message);
1213
    void _handleRadioStatus(mavlink_message_t& message);
Don Gagne's avatar
Don Gagne committed
1214 1215
    void _handleRCChannels(mavlink_message_t& message);
    void _handleRCChannelsRaw(mavlink_message_t& message);
Don Gagne's avatar
Don Gagne committed
1216 1217
    void _handleBatteryStatus(mavlink_message_t& message);
    void _handleSysStatus(mavlink_message_t& message);
1218
    void _handleWindCov(mavlink_message_t& message);
1219
    void _handleVibration(mavlink_message_t& message);
Don Gagne's avatar
Don Gagne committed
1220
    void _handleExtendedSysState(mavlink_message_t& message);
1221
    void _handleCommandAck(mavlink_message_t& message);
1222
    void _handleCommandLong(mavlink_message_t& message);
Gus Grubba's avatar
Gus Grubba committed
1223
    void _handleAutopilotVersion(LinkInterface* link, mavlink_message_t& message);
1224
    void _handleProtocolVersion(LinkInterface* link, mavlink_message_t& message);
1225
    void _handleHilActuatorControls(mavlink_message_t& message);
1226 1227 1228 1229
    void _handleGpsRawInt(mavlink_message_t& message);
    void _handleGlobalPositionInt(mavlink_message_t& message);
    void _handleAltitude(mavlink_message_t& message);
    void _handleVfrHud(mavlink_message_t& message);
1230 1231 1232
    void _handleScaledPressure(mavlink_message_t& message);
    void _handleScaledPressure2(mavlink_message_t& message);
    void _handleScaledPressure3(mavlink_message_t& message);
1233
    void _handleHighLatency2(mavlink_message_t& message);
1234 1235
    void _handleAttitudeWorker(double rollRadians, double pitchRadians, double yawRadians);
    void _handleAttitude(mavlink_message_t& message);
1236
    void _handleAttitudeQuaternion(mavlink_message_t& message);
DonLakeFlyer's avatar
DonLakeFlyer committed
1237
    void _handleAttitudeTarget(mavlink_message_t& message);
1238
    void _handleDistanceSensor(mavlink_message_t& message);
1239
    void _handleEstimatorStatus(mavlink_message_t& message);
1240
    void _handleStatusText(mavlink_message_t& message);
1241 1242
    // ArduPilot dialect messages
#if !defined(NO_ARDUPILOT_DIALECT)
1243
    void _handleCameraFeedback(const mavlink_message_t& message);
1244 1245
    void _handleWind(mavlink_message_t& message);
#endif
1246
    void _handleCameraImageCaptured(const mavlink_message_t& message);
1247
    void _handleADSBVehicle(const mavlink_message_t& message);
1248
    void _missionManagerError(int errorCode, const QString& errorMsg);
1249
    void _geoFenceManagerError(int errorCode, const QString& errorMsg);
1250
    void _rallyPointManagerError(int errorCode, const QString& errorMsg);
1251 1252
    void _mapTrajectoryStart(void);
    void _mapTrajectoryStop(void);
1253
    void _linkActiveChanged(LinkInterface* link, bool active, int vehicleID);
1254 1255
    void _say(const QString& text);
    QString _vehicleIdSpeech(void);
1256 1257 1258
    void _handleMavlinkLoggingData(mavlink_message_t& message);
    void _handleMavlinkLoggingDataAcked(mavlink_message_t& message);
    void _ackMavlinkLogData(uint16_t sequence);
1259
    void _sendNextQueuedMavCommand(void);
1260
    void _updatePriorityLink(bool updateActive, bool sendCommand);
1261
    void _commonInit(void);
DonLakeFlyer's avatar
DonLakeFlyer committed
1262
    void _startPlanRequest(void);
1263
    void _setupAutoDisarmSignalling(void);
DonLakeFlyer's avatar
DonLakeFlyer committed
1264
    void _setCapabilities(uint64_t capabilityBits);
DonLakeFlyer's avatar
DonLakeFlyer committed
1265 1266
    void _updateArmed(bool armed);
    bool _apmArmingNotRequired(void);
Don Gagne's avatar
Don Gagne committed
1267

1268
    int     _id;                    ///< Mavlink system id
1269
    int     _defaultComponentId;
1270
    bool    _active;
1271
    bool    _offlineEditingVehicle; ///< This Vehicle is a "disconnected" vehicle for ui use while offline editing
dogmaphobic's avatar
dogmaphobic committed
1272

1273
    MAV_AUTOPILOT       _firmwareType;
1274
    MAV_TYPE            _vehicleType;
1275
    FirmwarePlugin*     _firmwarePlugin;
1276
    QObject*            _firmwarePluginInstanceData;
1277
    AutoPilotPlugin*    _autopilotPlugin;
Don Gagne's avatar
Don Gagne committed
1278
    MAVLinkProtocol*    _mavlink;
1279
    bool                _soloFirmware;
1280
    QGCToolbox*         _toolbox;
1281
    SettingsManager*    _settingsManager;
dogmaphobic's avatar
dogmaphobic committed
1282

Don Gagne's avatar
Don Gagne committed
1283
    QList<LinkInterface*> _links;
dogmaphobic's avatar
dogmaphobic committed
1284

1285
    JoystickMode_t  _joystickMode;
1286
    bool            _joystickEnabled;
dogmaphobic's avatar
dogmaphobic committed
1287

1288
    UAS* _uas;
dogmaphobic's avatar
dogmaphobic committed
1289

1290
    QGeoCoordinate  _coordinate;
1291
    QGeoCoordinate  _homePosition;
dogmaphobic's avatar
dogmaphobic committed
1292

1293 1294 1295 1296 1297 1298 1299 1300 1301
    UASInterface*   _mav;
    int             _currentMessageCount;
    int             _messageCount;
    int             _currentErrorCount;
    int             _currentWarningCount;
    int             _currentNormalCount;
    MessageType_t   _currentMessageType;
    QString         _latestError;
    int             _updateCount;
dogmaphobic's avatar
dogmaphobic committed
1302
    QString         _formatedMessage;
Don Gagne's avatar
Don Gagne committed
1303 1304
    int             _rcRSSI;
    double          _rcRSSIstore;
Don Gagne's avatar
Don Gagne committed
1305
    bool            _autoDisconnect;    ///< true: Automatically disconnect vehicle when last connection goes away or lost heartbeat
Don Gagne's avatar
Don Gagne committed
1306
    bool            _flying;
1307
    bool            _landing;
1308
    bool            _vtolInFwdFlight;
1309 1310 1311 1312
    uint32_t        _onboardControlSensorsPresent;
    uint32_t        _onboardControlSensorsEnabled;
    uint32_t        _onboardControlSensorsHealth;
    uint32_t        _onboardControlSensorsUnhealthy;
1313 1314
    bool            _gpsRawIntMessageAvailable;
    bool            _globalPositionIntMessageAvailable;
DonLakeFlyer's avatar
DonLakeFlyer committed
1315 1316
    double          _defaultCruiseSpeed;
    double          _defaultHoverSpeed;
Gus Grubba's avatar
Gus Grubba committed
1317 1318 1319 1320 1321
    int             _telemetryRRSSI;
    int             _telemetryLRSSI;
    uint32_t        _telemetryRXErrors;
    uint32_t        _telemetryFixed;
    uint32_t        _telemetryTXBuffer;
1322 1323
    int             _telemetryLNoise;
    int             _telemetryRNoise;
1324
    unsigned        _maxProtoVersion;
1325
    bool            _vehicleCapabilitiesKnown;
1326
    uint64_t        _capabilityBits;
1327
    bool            _highLatencyLink;
1328
    bool            _receivingAttitudeQuaternion;
dogmaphobic's avatar
dogmaphobic committed
1329

1330 1331
    QGCCameraManager* _cameras;

1332
    typedef struct {
1333 1334 1335 1336 1337 1338
        int         component;
        bool        commandInt; // true: use COMMAND_INT, false: use COMMAND_LONG
        MAV_CMD     command;
        MAV_FRAME   frame;
        double      rgParam[7];
        bool        showError;
1339 1340 1341 1342 1343 1344
    } MavCommandQueueEntry_t;

    QList<MavCommandQueueEntry_t>   _mavCommandQueue;
    QTimer                          _mavCommandAckTimer;
    int                             _mavCommandRetryCount;
    static const int                _mavCommandMaxRetryCount = 3;
1345
    static const int                _mavCommandAckTimeoutMSecs = 3000;
DonLakeFlyer's avatar
DonLakeFlyer committed
1346
    static const int                _mavCommandAckTimeoutMSecsHighLatency = 120000;
1347

Don Gagne's avatar
Don Gagne committed
1348 1349 1350 1351
    QString             _prearmError;
    QTimer              _prearmErrorTimer;
    static const int    _prearmErrorTimeoutMSecs = 35 * 1000;   ///< Take away prearm error after 35 seconds

1352 1353 1354 1355
    // Lost connection handling
    bool                _connectionLost;
    bool                _connectionLostEnabled;

DonLakeFlyer's avatar
DonLakeFlyer committed
1356 1357
    bool                _initialPlanRequestComplete;

Don Gagne's avatar
Don Gagne committed
1358
    MissionManager*     _missionManager;
1359
    bool                _missionManagerInitialRequestSent;
1360

1361
    GeoFenceManager*    _geoFenceManager;
1362 1363 1364 1365
    bool                _geoFenceManagerInitialRequestSent;

    RallyPointManager*  _rallyPointManager;
    bool                _rallyPointManagerInitialRequestSent;
1366

1367 1368
    ParameterManager*   _parameterManager;

1369
#if defined(QGC_AIRMAP_ENABLED)
1370
    AirspaceVehicleManager* _airspaceVehicleManager;
1371
#endif
dogmaphobic's avatar
dogmaphobic committed
1372

Don Gagne's avatar
Don Gagne committed
1373 1374 1375
    bool    _armed;         ///< true: vehicle is armed
    uint8_t _base_mode;     ///< base_mode from HEARTBEAT
    uint32_t _custom_mode;  ///< custom_mode from HEARTBEAT
1376 1377 1378 1379 1380 1381

    /// Used to store a message being sent by sendMessageMultiple
    typedef struct {
        mavlink_message_t   message;    ///< Message to send multiple times
        int                 retryCount; ///< Number of retries left
    } SendMessageMultipleInfo_t;
dogmaphobic's avatar
dogmaphobic committed
1382

1383
    QList<SendMessageMultipleInfo_t> _sendMessageMultipleList;    ///< List of messages being sent multiple times
dogmaphobic's avatar
dogmaphobic committed
1384

1385 1386
    static const int _sendMessageMultipleRetries = 5;
    static const int _sendMessageMultipleIntraMessageDelay = 500;
dogmaphobic's avatar
dogmaphobic committed
1387

1388 1389
    QTimer  _sendMultipleTimer;
    int     _nextSendMessageMultipleIndex;
dogmaphobic's avatar
dogmaphobic committed
1390

1391
    QTime               _flightTimer;
1392 1393 1394 1395 1396
    QTimer              _mapTrajectoryTimer;
    QmlObjectListModel  _mapTrajectoryList;
    QGeoCoordinate      _mapTrajectoryLastCoordinate;
    bool                _mapTrajectoryHaveFirstCoordinate;
    static const int    _mapTrajectoryMsecsBetweenPoints = 1000;
1397

1398 1399
    QmlObjectListModel  _cameraTriggerPoints;

1400 1401
    QmlObjectListModel              _adsbVehicles;
    QMap<uint32_t, ADSBVehicle*>    _adsbICAOMap;
1402
    QMap<QString, ADSBVehicle*>     _trafficVehicleMap;
1403
    QTimer                          _adsbTimer;
1404

1405
    // Toolbox references
dogmaphobic's avatar
dogmaphobic committed
1406 1407 1408 1409 1410
    FirmwarePluginManager*      _firmwarePluginManager;
    JoystickManager*            _joystickManager;

    int                         _flowImageIndex;

Don Gagne's avatar
Don Gagne committed
1411 1412
    bool _allLinksInactiveSent; ///< true: allLinkInactive signal already sent one time

1413 1414 1415 1416 1417 1418 1419
    uint                _messagesReceived;
    uint                _messagesSent;
    uint                _messagesLost;
    uint8_t             _messageSeq;
    uint8_t             _compID;
    bool                _heardFrom;

Don Gagne's avatar
Don Gagne committed
1420 1421 1422
    int _firmwareMajorVersion;
    int _firmwareMinorVersion;
    int _firmwarePatchVersion;
1423 1424 1425
    int _firmwareCustomMajorVersion;
    int _firmwareCustomMinorVersion;
    int _firmwareCustomPatchVersion;
1426
    FIRMWARE_VERSION_TYPE _firmwareVersionType;
Don Gagne's avatar
Don Gagne committed
1427

1428
    QString _gitHash;
Gus Grubba's avatar
Gus Grubba committed
1429
    quint64 _uid;
1430

1431
    int _lastAnnouncedLowBatteryPercent;
1432

1433
    SharedLinkInterfacePointer _priorityLink;  // We always keep a reference to the priority link to manage shutdown ordering
1434
    bool _priorityLinkCommanded;
1435

1436 1437 1438 1439 1440
    uint64_t    _mavlinkSentCount       = 0;
    uint64_t    _mavlinkReceivedCount   = 0;
    uint64_t    _mavlinkLossCount       = 0;
    float       _mavlinkLossPercent     = 0.0f;

1441 1442
    QMap<QString, QTime> _noisySpokenPrearmMap; ///< Used to prevent PreArm messages from being spoken too often

Don Gagne's avatar
Don Gagne committed
1443 1444 1445 1446 1447
    // FactGroup facts

    Fact _rollFact;
    Fact _pitchFact;
    Fact _headingFact;
DonLakeFlyer's avatar
DonLakeFlyer committed
1448 1449 1450
    Fact _rollRateFact;
    Fact _pitchRateFact;
    Fact _yawRateFact;
Don Gagne's avatar
Don Gagne committed
1451 1452 1453 1454 1455
    Fact _groundSpeedFact;
    Fact _airSpeedFact;
    Fact _climbRateFact;
    Fact _altitudeRelativeFact;
    Fact _altitudeAMSLFact;
1456
    Fact _flightDistanceFact;
1457
    Fact _flightTimeFact;
1458
    Fact _distanceToHomeFact;
1459
    Fact _distanceToGCSFact;
1460
    Fact _hobbsFact;
Don Gagne's avatar
Don Gagne committed
1461

1462
    VehicleGPSFactGroup             _gpsFactGroup;
DonLakeFlyer's avatar
DonLakeFlyer committed
1463 1464
    VehicleBatteryFactGroup         _battery1FactGroup;
    VehicleBatteryFactGroup         _battery2FactGroup;
1465 1466 1467 1468 1469 1470
    VehicleWindFactGroup            _windFactGroup;
    VehicleVibrationFactGroup       _vibrationFactGroup;
    VehicleTemperatureFactGroup     _temperatureFactGroup;
    VehicleClockFactGroup           _clockFactGroup;
    VehicleSetpointFactGroup        _setpointFactGroup;
    VehicleDistanceSensorFactGroup  _distanceSensorFactGroup;
1471
    VehicleEstimatorStatusFactGroup _estimatorStatusFactGroup;
Don Gagne's avatar
Don Gagne committed
1472 1473 1474 1475

    static const char* _rollFactName;
    static const char* _pitchFactName;
    static const char* _headingFactName;
DonLakeFlyer's avatar
DonLakeFlyer committed
1476 1477 1478
    static const char* _rollRateFactName;
    static const char* _pitchRateFactName;
    static const char* _yawRateFactName;
Don Gagne's avatar
Don Gagne committed
1479 1480 1481 1482 1483
    static const char* _groundSpeedFactName;
    static const char* _airSpeedFactName;
    static const char* _climbRateFactName;
    static const char* _altitudeRelativeFactName;
    static const char* _altitudeAMSLFactName;
1484
    static const char* _flightDistanceFactName;
1485
    static const char* _flightTimeFactName;
1486
    static const char* _distanceToHomeFactName;
1487
    static const char* _distanceToGCSFactName;
1488
    static const char* _hobbsFactName;
Don Gagne's avatar
Don Gagne committed
1489

Don Gagne's avatar
Don Gagne committed
1490
    static const char* _gpsFactGroupName;
DonLakeFlyer's avatar
DonLakeFlyer committed
1491 1492
    static const char* _battery1FactGroupName;
    static const char* _battery2FactGroupName;
Don Gagne's avatar
Don Gagne committed
1493
    static const char* _windFactGroupName;
1494
    static const char* _vibrationFactGroupName;
1495
    static const char* _temperatureFactGroupName;
dheideman's avatar
dheideman committed
1496
    static const char* _clockFactGroupName;
1497
    static const char* _distanceSensorFactGroupName;
1498
    static const char* _estimatorStatusFactGroupName;
Don Gagne's avatar
Don Gagne committed
1499 1500 1501

    static const int _vehicleUIUpdateRateMSecs = 100;

1502
    // Settings keys
1503 1504
    static const char* _settingsGroup;
    static const char* _joystickModeSettingsKey;
1505
    static const char* _joystickEnabledSettingsKey;
Don Gagne's avatar
Don Gagne committed
1506

1507
};