VisualMissionItem.cc 6.6 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 "TerrainQuery.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, bool flyView, QObject* parent)
25 26
    : QObject                   (parent)
    , _vehicle                  (vehicle)
27
    , _flyView                  (flyView)
28 29 30 31 32 33 34
    , _isCurrentItem            (false)
    , _dirty                    (false)
    , _homePositionSpecialCase  (false)
    , _terrainAltitude          (qQNaN())
    , _altDifference            (0.0)
    , _altPercent               (0.0)
    , _terrainPercent           (qQNaN())
35
    , _terrainCollision         (false)
36 37 38 39 40 41
    , _azimuth                  (0.0)
    , _distance                 (0.0)
    , _missionGimbalYaw         (qQNaN())
    , _missionVehicleYaw        (qQNaN())
    , _lastLatTerrainQuery      (0)
    , _lastLonTerrainQuery      (0)
42
{
43
    _commonInit();
44 45
}

46
VisualMissionItem::VisualMissionItem(const VisualMissionItem& other, bool flyView, QObject* parent)
47 48
    : QObject                   (parent)
    , _vehicle                  (NULL)
49
    , _flyView                  (flyView)
50 51 52 53 54 55
    , _isCurrentItem            (false)
    , _dirty                    (false)
    , _homePositionSpecialCase  (false)
    , _altDifference            (0.0)
    , _altPercent               (0.0)
    , _terrainPercent           (qQNaN())
56
    , _terrainCollision         (false)
57 58
    , _azimuth                  (0.0)
    , _distance                 (0.0)
59 60
{
    *this = other;
61

62 63 64 65 66
    _commonInit();
}

void VisualMissionItem::_commonInit(void)
{
67
    // Don't get terrain altitude information for submarines or boats
68
    if (_vehicle->vehicleType() != MAV_TYPE_SUBMARINE && _vehicle->vehicleType() != MAV_TYPE_SURFACE_BOAT) {
69 70 71 72
        _updateTerrainTimer.setInterval(500);
        _updateTerrainTimer.setSingleShot(true);
        connect(&_updateTerrainTimer, &QTimer::timeout, this, &VisualMissionItem::_reallyUpdateTerrainAltitude);

73 74
        connect(this, &VisualMissionItem::coordinateChanged, this, &VisualMissionItem::_updateTerrainAltitude);
    }
75 76 77 78 79 80 81 82
}

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

    setIsCurrentItem(other._isCurrentItem);
    setDirty(other._dirty);
83
    _homePositionSpecialCase = other._homePositionSpecialCase;
84
    _terrainAltitude = other._terrainAltitude;
85 86
    setAltDifference(other._altDifference);
    setAltPercent(other._altPercent);
87
    setTerrainPercent(other._terrainPercent);
88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107
    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)
{
108 109 110 111
    if (!qFuzzyCompare(_distance, distance)) {
        _distance = distance;
        emit distanceChanged(_distance);
    }
112 113 114 115
}

void VisualMissionItem::setAltDifference(double altDifference)
{
116 117 118 119
    if (!qFuzzyCompare(_altDifference, altDifference)) {
        _altDifference = altDifference;
        emit altDifferenceChanged(_altDifference);
    }
120 121 122 123
}

void VisualMissionItem::setAltPercent(double altPercent)
{
124 125 126 127
    if (!qFuzzyCompare(_altPercent, altPercent)) {
        _altPercent = altPercent;
        emit altPercentChanged(_altPercent);
    }
128 129
}

130 131 132 133 134 135 136 137
void VisualMissionItem::setTerrainPercent(double terrainPercent)
{
    if (!qFuzzyCompare(_terrainPercent, terrainPercent)) {
        _terrainPercent = terrainPercent;
        emit terrainPercentChanged(terrainPercent);
    }
}

138 139 140 141 142 143 144 145
void VisualMissionItem::setTerrainCollision(bool terrainCollision)
{
    if (terrainCollision != _terrainCollision) {
        _terrainCollision = terrainCollision;
        emit terrainCollisionChanged(terrainCollision);
    }
}

146 147
void VisualMissionItem::setAzimuth(double azimuth)
{
148 149 150 151
    if (!qFuzzyCompare(_azimuth, azimuth)) {
        _azimuth = azimuth;
        emit azimuthChanged(_azimuth);
    }
152
}
153

DonLakeFlyer's avatar
DonLakeFlyer committed
154 155 156
void VisualMissionItem::setMissionFlightStatus(MissionController::MissionFlightStatus_t& missionFlightStatus)
{
    _missionFlightStatus = missionFlightStatus;
DonLakeFlyer's avatar
DonLakeFlyer committed
157 158 159
    if (qIsNaN(_missionFlightStatus.gimbalYaw) && qIsNaN(_missionGimbalYaw)) {
        return;
    }
DonLakeFlyer's avatar
DonLakeFlyer committed
160 161 162 163 164 165 166 167 168 169 170 171 172
    if (_missionFlightStatus.gimbalYaw != _missionGimbalYaw) {
        _missionGimbalYaw = _missionFlightStatus.gimbalYaw;
        emit missionGimbalYawChanged(_missionGimbalYaw);
    }
}

void VisualMissionItem::setMissionVehicleYaw(double vehicleYaw)
{
    if (!qFuzzyCompare(_missionVehicleYaw, vehicleYaw)) {
        _missionVehicleYaw = vehicleYaw;
        emit missionVehicleYawChanged(_missionVehicleYaw);
    }
}
173 174 175

void VisualMissionItem::_updateTerrainAltitude(void)
{
176 177 178 179
    if (coordinate().latitude() == 0 && coordinate().longitude() == 0) {
        // This is an intermediate state we don't react to
        return;
    }
180
    if (!_flyView && coordinate().isValid()) {
181 182 183 184 185 186 187 188 189 190 191
        // 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();
192
        TerrainAtCoordinateQuery* terrain = new TerrainAtCoordinateQuery(this);
DonLakeFlyer's avatar
DonLakeFlyer committed
193
        connect(terrain, &TerrainAtCoordinateQuery::terrainDataReceived, this, &VisualMissionItem::_terrainDataReceived);
194 195
        QList<QGeoCoordinate> rgCoord;
        rgCoord.append(coordinate());
196
        terrain->requestData(rgCoord);
197 198 199
    }
}

200
void VisualMissionItem::_terrainDataReceived(bool success, QList<double> heights)
201
{
Don Gagne's avatar
Don Gagne committed
202 203 204
    _terrainAltitude = success ? heights[0] : qQNaN();
    emit terrainAltitudeChanged(_terrainAltitude);
    sender()->deleteLater();
205
}