VisualMissionItem.cc 6.22 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.
 *
 ****************************************************************************/
9 10 11 12 13 14 15 16 17


#include <QStringList>
#include <QDebug>

#include "VisualMissionItem.h"
#include "FirmwarePluginManager.h"
#include "QGCApplication.h"
#include "JsonHelper.h"
18
#include "Terrain.h"
19

Don Gagne's avatar
Don Gagne committed
20 21 22 23
const char* VisualMissionItem::jsonTypeKey =                "type";
const char* VisualMissionItem::jsonTypeSimpleItemValue =    "SimpleItem";
const char* VisualMissionItem::jsonTypeComplexItemValue =   "ComplexItem";

24
VisualMissionItem::VisualMissionItem(Vehicle* vehicle, QObject* parent)
25 26 27 28 29 30 31 32 33 34 35 36 37 38 39
    : QObject                   (parent)
    , _vehicle                  (vehicle)
    , _isCurrentItem            (false)
    , _dirty                    (false)
    , _homePositionSpecialCase  (false)
    , _terrainAltitude          (qQNaN())
    , _altDifference            (0.0)
    , _altPercent               (0.0)
    , _terrainPercent           (qQNaN())
    , _azimuth                  (0.0)
    , _distance                 (0.0)
    , _missionGimbalYaw         (qQNaN())
    , _missionVehicleYaw        (qQNaN())
    , _lastLatTerrainQuery      (0)
    , _lastLonTerrainQuery      (0)
40 41
{

42 43 44 45 46 47 48 49
    // Don't get terrain altitude information for submarines or boards
    if (_vehicle->vehicleType() != MAV_TYPE_SUBMARINE && _vehicle->vehicleType() != MAV_TYPE_SURFACE_BOAT) {
        _updateTerrainTimer.setInterval(500);
        _updateTerrainTimer.setSingleShot(true);
        connect(&_updateTerrainTimer, &QTimer::timeout, this, &VisualMissionItem::_reallyUpdateTerrainAltitude);

        connect(this, &VisualMissionItem::coordinateChanged, this, &VisualMissionItem::_updateTerrainAltitude);
    }
50 51 52
}

VisualMissionItem::VisualMissionItem(const VisualMissionItem& other, QObject* parent)
53 54 55 56 57 58 59 60 61 62
    : QObject                   (parent)
    , _vehicle                  (NULL)
    , _isCurrentItem            (false)
    , _dirty                    (false)
    , _homePositionSpecialCase  (false)
    , _altDifference            (0.0)
    , _altPercent               (0.0)
    , _terrainPercent           (qQNaN())
    , _azimuth                  (0.0)
    , _distance                 (0.0)
63 64
{
    *this = other;
65 66 67 68 69

    // Don't get terrain altitude information for submarines or boards
    if (_vehicle->vehicleType() != MAV_TYPE_SUBMARINE && _vehicle->vehicleType() != MAV_TYPE_SURFACE_BOAT) {
        connect(this, &VisualMissionItem::coordinateChanged, this, &VisualMissionItem::_updateTerrainAltitude);
    }
70 71 72 73 74 75 76 77
}

const VisualMissionItem& VisualMissionItem::operator=(const VisualMissionItem& other)
{
    _vehicle = other._vehicle;

    setIsCurrentItem(other._isCurrentItem);
    setDirty(other._dirty);
78
    _homePositionSpecialCase = other._homePositionSpecialCase;
79
    _terrainAltitude = other._terrainAltitude;
80 81
    setAltDifference(other._altDifference);
    setAltPercent(other._altPercent);
82
    setTerrainPercent(other._terrainPercent);
83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102
    setAzimuth(other._azimuth);
    setDistance(other._distance);

    return *this;
}

VisualMissionItem::~VisualMissionItem()
{    
}

void VisualMissionItem::setIsCurrentItem(bool isCurrentItem)
{
    if (_isCurrentItem != isCurrentItem) {
        _isCurrentItem = isCurrentItem;
        emit isCurrentItemChanged(isCurrentItem);
    }
}

void VisualMissionItem::setDistance(double distance)
{
103 104 105 106
    if (!qFuzzyCompare(_distance, distance)) {
        _distance = distance;
        emit distanceChanged(_distance);
    }
107 108 109 110
}

void VisualMissionItem::setAltDifference(double altDifference)
{
111 112 113 114
    if (!qFuzzyCompare(_altDifference, altDifference)) {
        _altDifference = altDifference;
        emit altDifferenceChanged(_altDifference);
    }
115 116 117 118
}

void VisualMissionItem::setAltPercent(double altPercent)
{
119 120 121 122
    if (!qFuzzyCompare(_altPercent, altPercent)) {
        _altPercent = altPercent;
        emit altPercentChanged(_altPercent);
    }
123 124
}

125 126 127 128 129 130 131 132
void VisualMissionItem::setTerrainPercent(double terrainPercent)
{
    if (!qFuzzyCompare(_terrainPercent, terrainPercent)) {
        _terrainPercent = terrainPercent;
        emit terrainPercentChanged(terrainPercent);
    }
}

133 134
void VisualMissionItem::setAzimuth(double azimuth)
{
135 136 137 138
    if (!qFuzzyCompare(_azimuth, azimuth)) {
        _azimuth = azimuth;
        emit azimuthChanged(_azimuth);
    }
139
}
140

DonLakeFlyer's avatar
DonLakeFlyer committed
141 142 143
void VisualMissionItem::setMissionFlightStatus(MissionController::MissionFlightStatus_t& missionFlightStatus)
{
    _missionFlightStatus = missionFlightStatus;
DonLakeFlyer's avatar
DonLakeFlyer committed
144 145 146
    if (qIsNaN(_missionFlightStatus.gimbalYaw) && qIsNaN(_missionGimbalYaw)) {
        return;
    }
DonLakeFlyer's avatar
DonLakeFlyer committed
147 148 149 150 151 152 153 154 155 156 157 158 159
    if (_missionFlightStatus.gimbalYaw != _missionGimbalYaw) {
        _missionGimbalYaw = _missionFlightStatus.gimbalYaw;
        emit missionGimbalYawChanged(_missionGimbalYaw);
    }
}

void VisualMissionItem::setMissionVehicleYaw(double vehicleYaw)
{
    if (!qFuzzyCompare(_missionVehicleYaw, vehicleYaw)) {
        _missionVehicleYaw = vehicleYaw;
        emit missionVehicleYawChanged(_missionVehicleYaw);
    }
}
160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190

void VisualMissionItem::_updateTerrainAltitude(void)
{
    if (coordinate().isValid()) {
        // We use a timer so that any additional requests before the timer fires result in only a single request
        _updateTerrainTimer.start();
    }
}

void VisualMissionItem::_reallyUpdateTerrainAltitude(void)
{
    QGeoCoordinate coord = coordinate();
    if (coord.isValid() && (qIsNaN(_terrainAltitude) || !qFuzzyCompare(_lastLatTerrainQuery, coord.latitude()) || qFuzzyCompare(_lastLonTerrainQuery, coord.longitude()))) {
        _lastLatTerrainQuery = coord.latitude();
        _lastLonTerrainQuery = coord.longitude();
        ElevationProvider* terrain = new ElevationProvider(this);
        connect(terrain, &ElevationProvider::terrainData, this, &VisualMissionItem::_terrainDataReceived);
        QList<QGeoCoordinate> rgCoord;
        rgCoord.append(coordinate());
        terrain->queryTerrainData(rgCoord);
    }
}

void VisualMissionItem::_terrainDataReceived(bool success, QList<float> altitudes)
{
    if (success) {
        _terrainAltitude = altitudes[0];
        emit terrainAltitudeChanged(_terrainAltitude);
        sender()->deleteLater();
    }
}