StructureScanComplexItem.cc 25.9 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23
/****************************************************************************
 *
 *   (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.
 *
 ****************************************************************************/

#include "StructureScanComplexItem.h"
#include "JsonHelper.h"
#include "MissionController.h"
#include "QGCGeo.h"
#include "QGroundControlQmlGlobal.h"
#include "QGCQGeoCoordinate.h"
#include "SettingsManager.h"
#include "AppSettings.h"
#include "QGCQGeoCoordinate.h"

#include <QPolygonF>

QGC_LOGGING_CATEGORY(StructureScanComplexItemLog, "StructureScanComplexItemLog")

24
const char* StructureScanComplexItem::settingsGroup =               "StructureScan";
25 26
const char* StructureScanComplexItem::_entranceAltName =            "EntranceAltitude";
const char* StructureScanComplexItem::scanBottomAltName =           "Altitude";
27 28
const char* StructureScanComplexItem::structureHeightName =         "StructureHeight";
const char* StructureScanComplexItem::layersName =                  "Layers";
29
const char* StructureScanComplexItem::gimbalPitchName =             "GimbalPitch";
30
const char* StructureScanComplexItem::startFromTopName =            "StartFromTop";
31

32 33 34
const char* StructureScanComplexItem::jsonComplexItemTypeValue =    "StructureScan";
const char* StructureScanComplexItem::_jsonCameraCalcKey =          "CameraCalc";
const char* StructureScanComplexItem::_jsonAltitudeRelativeKey =    "altitudeRelative";
35

36
StructureScanComplexItem::StructureScanComplexItem(Vehicle* vehicle, bool flyView, const QString& kmlOrShpFile, QObject* parent)
37
    : ComplexMissionItem        (vehicle, flyView, parent)
38
    , _metaDataMap              (FactMetaData::createMapFromJsonFile(QStringLiteral(":/json/StructureScan.SettingsGroup.json"), this /* QObject parent */))
39 40 41 42 43 44 45
    , _sequenceNumber           (0)
    , _dirty                    (false)
    , _altitudeRelative         (true)
    , _entryVertex              (0)
    , _ignoreRecalc             (false)
    , _scanDistance             (0.0)
    , _cameraShots              (0)
46
    , _cameraCalc               (vehicle, settingsGroup)
47
    , _scanBottomAltFact        (settingsGroup, _metaDataMap[scanBottomAltName])
48 49
    , _structureHeightFact      (settingsGroup, _metaDataMap[structureHeightName])
    , _layersFact               (settingsGroup, _metaDataMap[layersName])
50
    , _gimbalPitchFact          (settingsGroup, _metaDataMap[gimbalPitchName])
51
    , _startFromTopFact         (settingsGroup, _metaDataMap[startFromTopName])
52
    , _entranceAltFact          (settingsGroup, _metaDataMap[_entranceAltName])
53 54 55
{
    _editorQml = "qrc:/qml/StructureScanEditor.qml";

56
    _entranceAltFact.setRawValue(qgcApp()->toolbox()->settingsManager()->appSettings()->defaultMissionItemAltitude()->rawValue());
57

58 59 60 61 62
    connect(&_entranceAltFact,      &Fact::valueChanged, this, &StructureScanComplexItem::_setDirty);
    connect(&_scanBottomAltFact,    &Fact::valueChanged, this, &StructureScanComplexItem::_setDirty);
    connect(&_layersFact,           &Fact::valueChanged, this, &StructureScanComplexItem::_setDirty);
    connect(&_gimbalPitchFact,      &Fact::valueChanged, this, &StructureScanComplexItem::_setDirty);
    connect(&_startFromTopFact,     &Fact::valueChanged, this, &StructureScanComplexItem::_setDirty);
63

DonLakeFlyer's avatar
DonLakeFlyer committed
64 65 66 67
    connect(&_layersFact,                           &Fact::valueChanged,    this, &StructureScanComplexItem::_recalcLayerInfo);
    connect(&_structureHeightFact,                  &Fact::valueChanged,    this, &StructureScanComplexItem::_recalcLayerInfo);
    connect(_cameraCalc.adjustedFootprintFrontal(), &Fact::valueChanged,    this, &StructureScanComplexItem::_recalcLayerInfo);

68 69 70
    connect(this, &StructureScanComplexItem::altitudeRelativeChanged,       this, &StructureScanComplexItem::_setDirty);
    connect(this, &StructureScanComplexItem::altitudeRelativeChanged,       this, &StructureScanComplexItem::coordinateHasRelativeAltitudeChanged);
    connect(this, &StructureScanComplexItem::altitudeRelativeChanged,       this, &StructureScanComplexItem::exitCoordinateHasRelativeAltitudeChanged);
71

72
    connect(&_entranceAltFact, &Fact::valueChanged, this, &StructureScanComplexItem::_updateCoordinateAltitudes);
73

74 75 76
    connect(&_structurePolygon, &QGCMapPolygon::dirtyChanged,   this, &StructureScanComplexItem::_polygonDirtyChanged);
    connect(&_structurePolygon, &QGCMapPolygon::pathChanged,    this, &StructureScanComplexItem::_rebuildFlightPolygon);

77 78 79
    connect(&_structurePolygon, &QGCMapPolygon::countChanged,   this, &StructureScanComplexItem::_updateLastSequenceNumber);
    connect(&_layersFact,       &Fact::valueChanged,            this, &StructureScanComplexItem::_updateLastSequenceNumber);

80
    connect(&_flightPolygon,    &QGCMapPolygon::pathChanged,    this, &StructureScanComplexItem::_flightPathChanged);
81
    connect(&_flightPolygon,    &QGCMapPolygon::countChanged,   this, &StructureScanComplexItem::_validateEntryVertex);
82

83
    connect(_cameraCalc.distanceToSurface(),    &Fact::valueChanged,                this, &StructureScanComplexItem::_rebuildFlightPolygon);
84 85 86 87

    connect(&_flightPolygon,                        &QGCMapPolygon::pathChanged,    this, &StructureScanComplexItem::_recalcCameraShots);
    connect(_cameraCalc.adjustedFootprintSide(),    &Fact::valueChanged,            this, &StructureScanComplexItem::_recalcCameraShots);
    connect(&_layersFact,                           &Fact::valueChanged,            this, &StructureScanComplexItem::_recalcCameraShots);
DonLakeFlyer's avatar
DonLakeFlyer committed
88

89 90
    connect(&_cameraCalc, &CameraCalc::isManualCameraChanged, this, &StructureScanComplexItem::_updateGimbalPitch);

DonLakeFlyer's avatar
DonLakeFlyer committed
91
    _recalcLayerInfo();
92

93 94
    if (!kmlOrShpFile.isEmpty()) {
        _structurePolygon.loadKMLOrSHPFile(kmlOrShpFile);
95 96 97 98
        _structurePolygon.setDirty(false);
    }

    setDirty(false);
99 100 101 102 103 104
}

void StructureScanComplexItem::_setScanDistance(double scanDistance)
{
    if (!qFuzzyCompare(_scanDistance, scanDistance)) {
        _scanDistance = scanDistance;
105
        emit complexDistanceChanged();
106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124
    }
}

void StructureScanComplexItem::_setCameraShots(int cameraShots)
{
    if (_cameraShots != cameraShots) {
        _cameraShots = cameraShots;
        emit cameraShotsChanged(this->cameraShots());
    }
}

void StructureScanComplexItem::_clearInternal(void)
{
    setDirty(true);

    emit specifiesCoordinateChanged();
    emit lastSequenceNumberChanged(lastSequenceNumber());
}

125
void StructureScanComplexItem::_updateLastSequenceNumber(void)
126 127 128 129 130 131
{
    emit lastSequenceNumberChanged(lastSequenceNumber());
}

int StructureScanComplexItem::lastSequenceNumber(void) const
{
132 133 134 135 136
    // Each structure layer contains:
    //  1 waypoint for each polygon vertex + 1 to go back to first polygon vertex for each layer
    //  Two commands for camera trigger start/stop
    int layerItemCount = _flightPolygon.count() + 1 + 2;

137
    // Take into account the number of layers
138 139
    int multiLayerItemCount = layerItemCount * _layersFact.rawValue().toInt();

140 141 142
    // +2 for ROI_WPNEXT_OFFSET and ROI_NONE commands
    // +2 for entrance/exit waypoints
    int itemCount = multiLayerItemCount + 2 + 2;
143 144

    return _sequenceNumber + itemCount - 1;
145 146 147 148 149 150 151 152 153 154 155 156 157 158
}

void StructureScanComplexItem::setDirty(bool dirty)
{
    if (_dirty != dirty) {
        _dirty = dirty;
        emit dirtyChanged(_dirty);
    }
}

void StructureScanComplexItem::save(QJsonArray&  missionItems)
{
    QJsonObject saveObject;

159
    // Header
DonLakeFlyer's avatar
DonLakeFlyer committed
160
    saveObject[JsonHelper::jsonVersionKey] =                    2;
161 162 163
    saveObject[VisualMissionItem::jsonTypeKey] =                VisualMissionItem::jsonTypeComplexItemValue;
    saveObject[ComplexMissionItem::jsonComplexItemTypeKey] =    jsonComplexItemTypeValue;

164 165
    saveObject[_entranceAltName] =          _entranceAltFact.rawValue().toDouble();
    saveObject[scanBottomAltName] =         _scanBottomAltFact.rawValue().toDouble();
166 167
    saveObject[structureHeightName] =       _structureHeightFact.rawValue().toDouble();
    saveObject[_jsonAltitudeRelativeKey] =  _altitudeRelative;
168
    saveObject[layersName] =                _layersFact.rawValue().toDouble();
169
    saveObject[gimbalPitchName] =           _gimbalPitchFact.rawValue().toDouble();
170
    saveObject[startFromTopName] =          _startFromTopFact.rawValue().toBool();
171 172 173 174 175

    QJsonObject cameraCalcObject;
    _cameraCalc.save(cameraCalcObject);
    saveObject[_jsonCameraCalcKey] = cameraCalcObject;

176
    _structurePolygon.saveToJson(saveObject);
177 178 179 180 181 182 183 184 185 186 187 188 189 190 191

    missionItems.append(saveObject);
}

void StructureScanComplexItem::setSequenceNumber(int sequenceNumber)
{
    if (_sequenceNumber != sequenceNumber) {
        _sequenceNumber = sequenceNumber;
        emit sequenceNumberChanged(sequenceNumber);
        emit lastSequenceNumberChanged(lastSequenceNumber());
    }
}

bool StructureScanComplexItem::load(const QJsonObject& complexObject, int sequenceNumber, QString& errorString)
{
192
    QList<JsonHelper::KeyValidateInfo> keyInfoList = {
193 194 195 196
        { JsonHelper::jsonVersionKey,                   QJsonValue::Double, true },
        { VisualMissionItem::jsonTypeKey,               QJsonValue::String, true },
        { ComplexMissionItem::jsonComplexItemTypeKey,   QJsonValue::String, true },
        { QGCMapPolygon::jsonPolygonKey,                QJsonValue::Array,  true },
197
        { scanBottomAltName,                            QJsonValue::Double, true },
198
        { structureHeightName,                          QJsonValue::Double, true },
DonLakeFlyer's avatar
DonLakeFlyer committed
199
        { _jsonAltitudeRelativeKey,                     QJsonValue::Bool,   true },
200
        { layersName,                                   QJsonValue::Double, true },
201
        { _jsonCameraCalcKey,                           QJsonValue::Object, true },
202 203 204 205
        // The following values were added after initial implementation so they may be missing from older files. Hence optional.
        { _entranceAltName,                             QJsonValue::Double, false },
        { gimbalPitchName,                              QJsonValue::Double, false },
        { startFromTopName,                             QJsonValue::Bool,   false },
206
    };
207
    if (!JsonHelper::validateKeys(complexObject, keyInfoList, errorString)) {
208 209 210
        return false;
    }

211 212 213 214
    _structurePolygon.clear();

    QString itemType = complexObject[VisualMissionItem::jsonTypeKey].toString();
    QString complexType = complexObject[ComplexMissionItem::jsonComplexItemTypeKey].toString();
215 216 217 218 219
    if (itemType != VisualMissionItem::jsonTypeComplexItemValue || complexType != jsonComplexItemTypeValue) {
        errorString = tr("%1 does not support loading this complex mission item type: %2:%3").arg(qgcApp()->applicationName()).arg(itemType).arg(complexType);
        return false;
    }

220
    int version = complexObject[JsonHelper::jsonVersionKey].toInt();
DonLakeFlyer's avatar
DonLakeFlyer committed
221
    if (version != 2) {
222
        errorString = tr("%1 complex item version %2 not supported").arg(jsonComplexItemTypeValue).arg(version);
223 224 225
        return false;
    }

226
    setSequenceNumber(sequenceNumber);
227

228 229 230 231 232
    // Load CameraCalc first since it will trigger camera name change which will trounce gimbal angles
    if (!_cameraCalc.load(complexObject[_jsonCameraCalcKey].toObject(), errorString)) {
        return false;
    }

233
    _scanBottomAltFact.setRawValue  (complexObject[scanBottomAltName].toDouble());
Don Gagne's avatar
Don Gagne committed
234 235
    _layersFact.setRawValue         (complexObject[layersName].toDouble());
    _structureHeightFact.setRawValue(complexObject[structureHeightName].toDouble());
236 237 238 239 240 241 242 243

    // Start from top is a new setting which may not exist in older saved structure scans.
    // Default to false if doesn't exist, which matches previous functionality.
    _startFromTopFact.setRawValue   (complexObject[startFromTopName].toBool(false));

    // Entrance altitude is a new setting which may not exist in older saved structure scans.
    // We default it to the top of the structure which is the safest thing to do without a value.
    _entranceAltFact.setRawValue    (complexObject[startFromTopName].toDouble(_scanBottomAltFact.rawValue().toDouble() + _structureHeightFact.rawValue().toDouble()));
Don Gagne's avatar
Don Gagne committed
244 245

    _altitudeRelative = complexObject[_jsonAltitudeRelativeKey].toBool(true);
246

247 248 249 250 251 252
    double gimbalPitchValue = 0;
    if (complexObject.contains(gimbalPitchName)) {
        gimbalPitchValue = complexObject[gimbalPitchName].toDouble();
    }
    _gimbalPitchFact.setRawValue(gimbalPitchValue);

253
    if (!_structurePolygon.loadFromJson(complexObject, true /* required */, errorString)) {
254
        _structurePolygon.clear();
255 256 257 258 259 260
        return false;
    }

    return true;
}

261
void StructureScanComplexItem::_flightPathChanged(void)
262
{
263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286
    // Calc bounding cube
    double north = 0.0;
    double south = 180.0;
    double east  = 0.0;
    double west  = 360.0;
    double bottom = 100000.;
    double top = 0.;
    QList<QGeoCoordinate> vertices = _flightPolygon.coordinateList();
    for (int i = 0; i < vertices.count(); i++) {
        QGeoCoordinate vertex = vertices[i];
        double lat = vertex.latitude()  + 90.0;
        double lon = vertex.longitude() + 180.0;
        north   = fmax(north, lat);
        south   = fmin(south, lat);
        east    = fmax(east,  lon);
        west    = fmin(west,  lon);
        bottom  = fmin(bottom, vertex.altitude());
        top     = fmax(top, vertex.altitude());
    }
    //-- Update bounding cube for airspace management control
    _setBoundingCube(QGCGeoBoundingCube(
        QGeoCoordinate(north - 90.0, west - 180.0, bottom),
        QGeoCoordinate(south - 90.0, east - 180.0, top)));

287 288 289 290 291 292 293 294
    emit coordinateChanged(coordinate());
    emit exitCoordinateChanged(exitCoordinate());
    emit greatestDistanceToChanged();
}

double StructureScanComplexItem::greatestDistanceTo(const QGeoCoordinate &other) const
{
    double greatestDistance = 0.0;
295
    QList<QGeoCoordinate> vertices = _flightPolygon.coordinateList();
296 297 298 299 300 301 302 303 304 305 306 307 308 309

    for (int i=0; i<vertices.count(); i++) {
        QGeoCoordinate vertex = vertices[i];
        double distance = vertex.distanceTo(other);
        if (distance > greatestDistance) {
            greatestDistance = distance;
        }
    }

    return greatestDistance;
}

bool StructureScanComplexItem::specifiesCoordinate(void) const
{
310
    return _flightPolygon.count() > 2;
311 312 313 314
}

void StructureScanComplexItem::appendMissionItems(QList<MissionItem*>& items, QObject* missionItemParent)
{
315 316
    int     seqNum =        _sequenceNumber;
    bool    startFromTop =  _startFromTopFact.rawValue().toBool();
317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335
    double  startAltitude = _scanBottomAltFact.rawValue().toDouble() + (startFromTop ? _structureHeightFact.rawValue().toDouble() : 0);

    MissionItem* item = nullptr;

    // Entrance waypoint
    QGeoCoordinate entranceExitCoord = _flightPolygon.vertexCoordinate(_entryVertex);
    item = new MissionItem(seqNum++,
                           MAV_CMD_NAV_WAYPOINT,
                           _altitudeRelative ? MAV_FRAME_GLOBAL_RELATIVE_ALT : MAV_FRAME_GLOBAL,
                           0,                                          // No hold time
                           0.0,                                        // No acceptance radius specified
                           0.0,                                        // Pass through waypoint
                           std::numeric_limits<double>::quiet_NaN(),   // Yaw unchanged
                           entranceExitCoord.latitude(),
                           entranceExitCoord.longitude(),
                           _entranceAltFact.rawValue().toDouble(),
                           true,                                       // autoContinue
                           false,                                      // isCurrentItem
                           missionItemParent);
336
    items.append(item);
337

338 339 340 341 342 343 344 345 346 347 348 349 350 351
    // Point camera at structure
    item = new MissionItem(seqNum++,
                           MAV_CMD_DO_SET_ROI_WPNEXT_OFFSET,
                           MAV_FRAME_MISSION,
                           0, 0, 0, 0,                             // param 1-4 not used
                           _gimbalPitchFact.rawValue().toDouble(),
                           0,                                      // Roll stays in standard orientation
                           90,                                     // 90 degreee yaw offset to point to structure
                           true,                                   // autoContinue
                           false,                                  // isCurrentItem
                           missionItemParent);
    items.append(item);

    // Fly a layer pattern
352
    for (int layer=0; layer<_layersFact.rawValue().toInt(); layer++) {
353 354 355 356 357 358 359 360 361
        bool    addTriggerStart = true;
        double  layerIncrement = (_cameraCalc.adjustedFootprintFrontal()->rawValue().toDouble() / 2.0) + (layer * _cameraCalc.adjustedFootprintFrontal()->rawValue().toDouble());
        double  layerAltitude;

        if (startFromTop) {
            layerAltitude = startAltitude - layerIncrement;
        } else {
            layerAltitude = startAltitude + layerIncrement;
        }
362

363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381
        bool done = false;
        int currentVertex = _entryVertex;
        int processedVertices = 0;
        do {
            QGeoCoordinate vertexCoord = _flightPolygon.vertexCoordinate(currentVertex);

            item = new MissionItem(seqNum++,
                                   MAV_CMD_NAV_WAYPOINT,
                                   _altitudeRelative ? MAV_FRAME_GLOBAL_RELATIVE_ALT : MAV_FRAME_GLOBAL,
                                   0,                                          // No hold time
                                   0.0,                                        // No acceptance radius specified
                                   0.0,                                        // Pass through waypoint
                                   std::numeric_limits<double>::quiet_NaN(),   // Yaw unchanged
                                   vertexCoord.latitude(),
                                   vertexCoord.longitude(),
                                   layerAltitude,
                                   true,                                       // autoContinue
                                   false,                                      // isCurrentItem
                                   missionItemParent);
382
            items.append(item);
383

384
            // Start camera triggering after first waypoint in layer
385 386 387 388 389 390 391 392 393 394 395 396 397 398
            if (addTriggerStart) {
                addTriggerStart = false;
                item = new MissionItem(seqNum++,
                                       MAV_CMD_DO_SET_CAM_TRIGG_DIST,
                                       MAV_FRAME_MISSION,
                                       _cameraCalc.adjustedFootprintSide()->rawValue().toDouble(),  // trigger distance
                                       0,                                                           // shutter integration (ignore)
                                       1,                                                           // trigger immediately when starting
                                       0, 0, 0, 0,                                                  // param 4-7 unused
                                       true,                                                        // autoContinue
                                       false,                                                       // isCurrentItem
                                       missionItemParent);
                items.append(item);
            }
399

400 401 402 403 404 405 406 407 408 409
            // Move to next vertext
            currentVertex++;
            if (currentVertex >= _flightPolygon.count()) {
                currentVertex = 0;
            }

            // Have we processed all the vertices
            processedVertices++;
            done = processedVertices == _flightPolygon.count() + 1;
        } while (!done);
410

411
        // Stop camera triggering after last waypoint in layer
412 413 414 415 416 417 418 419 420 421
        item = new MissionItem(seqNum++,
                               MAV_CMD_DO_SET_CAM_TRIGG_DIST,
                               MAV_FRAME_MISSION,
                               0,           // stop triggering
                               0,           // shutter integration (ignore)
                               0,           // trigger immediately when starting
                               0, 0, 0, 0,  // param 4-7 unused
                               true,        // autoContinue
                               false,       // isCurrentItem
                               missionItemParent);
422 423
        items.append(item);
    }
424

425
    // Return camera to neutral position
426 427 428 429 430 431 432 433
    item = new MissionItem(seqNum++,
                           MAV_CMD_DO_SET_ROI_NONE,
                           MAV_FRAME_MISSION,
                           0, 0, 0,0, 0, 0, 0,                 // param 1-7 not used
                           true,                               // autoContinue
                           false,                              // isCurrentItem
                           missionItemParent);
    items.append(item);
434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450

    // Exit waypoint
    item = new MissionItem(seqNum++,
                           MAV_CMD_NAV_WAYPOINT,
                           _altitudeRelative ? MAV_FRAME_GLOBAL_RELATIVE_ALT : MAV_FRAME_GLOBAL,
                           0,                                          // No hold time
                           0.0,                                        // No acceptance radius specified
                           0.0,                                        // Pass through waypoint
                           std::numeric_limits<double>::quiet_NaN(),   // Yaw unchanged
                           entranceExitCoord.latitude(),
                           entranceExitCoord.longitude(),
                           _entranceAltFact.rawValue().toDouble(),
                           true,                                       // autoContinue
                           false,                                      // isCurrentItem
                           missionItemParent);
    items.append(item);

451 452 453 454
}

int StructureScanComplexItem::cameraShots(void) const
{
455
    return _cameraShots;
456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473
}

void StructureScanComplexItem::setMissionFlightStatus(MissionController::MissionFlightStatus_t& missionFlightStatus)
{
    ComplexMissionItem::setMissionFlightStatus(missionFlightStatus);
    if (!qFuzzyCompare(_cruiseSpeed, missionFlightStatus.vehicleSpeed)) {
        _cruiseSpeed = missionFlightStatus.vehicleSpeed;
        emit timeBetweenShotsChanged();
    }
}

void StructureScanComplexItem::_setDirty(void)
{
    setDirty(true);
}

void StructureScanComplexItem::applyNewAltitude(double newAltitude)
{
474
    _entranceAltFact.setRawValue(newAltitude);
475 476 477 478 479 480 481 482 483
}

void StructureScanComplexItem::_polygonDirtyChanged(bool dirty)
{
    if (dirty) {
        setDirty(true);
    }
}

484
double StructureScanComplexItem::timeBetweenShots(void)
485
{
486
    return _cruiseSpeed == 0 ? 0 : _cameraCalc.adjustedFootprintSide()->rawValue().toDouble() / _cruiseSpeed;
487 488 489 490
}

QGeoCoordinate StructureScanComplexItem::coordinate(void) const
{
491
    if (_flightPolygon.count() > 0) {
492 493 494
        QGeoCoordinate coord = _flightPolygon.vertexCoordinate(_entryVertex);
        coord.setAltitude(_entranceAltFact.rawValue().toDouble());
        return coord;
495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513
    } else {
        return QGeoCoordinate();
    }
}

QGeoCoordinate StructureScanComplexItem::exitCoordinate(void) const
{
    return coordinate();
}

void StructureScanComplexItem::_updateCoordinateAltitudes(void)
{
    emit coordinateChanged(coordinate());
    emit exitCoordinateChanged(exitCoordinate());
}

void StructureScanComplexItem::rotateEntryPoint(void)
{
    _entryVertex++;
514
    if (_entryVertex >= _flightPolygon.count()) {
515 516 517 518 519
        _entryVertex = 0;
    }
    emit coordinateChanged(coordinate());
    emit exitCoordinateChanged(exitCoordinate());
}
520 521 522 523

void StructureScanComplexItem::_rebuildFlightPolygon(void)
{
    _flightPolygon = _structurePolygon;
524
    _flightPolygon.offset(_cameraCalc.distanceToSurface()->rawValue().toDouble());
525
}
526 527 528

void StructureScanComplexItem::_recalcCameraShots(void)
{
529 530 531 532 533 534
    double triggerDistance = _cameraCalc.adjustedFootprintSide()->rawValue().toDouble();
    if (triggerDistance == 0) {
        _setCameraShots(0);
        return;
    }

535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551
    if (_flightPolygon.count() < 3) {
        _setCameraShots(0);
        return;
    }

    // Determine the distance for each polygon traverse
    double distance = 0;
    for (int i=0; i<_flightPolygon.count(); i++) {
        QGeoCoordinate coord1 = _flightPolygon.vertexCoordinate(i);
        QGeoCoordinate coord2 = _flightPolygon.vertexCoordinate(i + 1 == _flightPolygon.count() ? 0 : i + 1);
        distance += coord1.distanceTo(coord2);
    }
    if (distance == 0.0) {
        _setCameraShots(0);
        return;
    }

552
    int cameraShots = static_cast<int>(distance / triggerDistance);
553 554
    _setCameraShots(cameraShots * _layersFact.rawValue().toInt());
}
555 556 557 558 559 560 561 562

void StructureScanComplexItem::setAltitudeRelative(bool altitudeRelative)
{
    if (altitudeRelative != _altitudeRelative) {
        _altitudeRelative = altitudeRelative;
        emit altitudeRelativeChanged(altitudeRelative);
    }
}
DonLakeFlyer's avatar
DonLakeFlyer committed
563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579

void StructureScanComplexItem::_recalcLayerInfo(void)
{
    if (_cameraCalc.isManualCamera()) {
        // Structure height is calculated from layer count, layer height.
        _structureHeightFact.setSendValueChangedSignals(false);
        _structureHeightFact.setRawValue(_layersFact.rawValue().toInt() * _cameraCalc.adjustedFootprintFrontal()->rawValue().toDouble());
        _structureHeightFact.clearDeferredValueChangeSignal();
        _structureHeightFact.setSendValueChangedSignals(true);
    } else {
        // Layer count is calculated from structure and layer heights
        _layersFact.setSendValueChangedSignals(false);
        _layersFact.setRawValue(qCeil(_structureHeightFact.rawValue().toDouble() / _cameraCalc.adjustedFootprintFrontal()->rawValue().toDouble()));
        _layersFact.clearDeferredValueChangeSignal();
        _layersFact.setSendValueChangedSignals(true);
    }
}
580 581 582 583 584 585 586

void StructureScanComplexItem::_updateGimbalPitch(void)
{
    if (!_cameraCalc.isManualCamera()) {
        _gimbalPitchFact.setRawValue(0);
    }
}
587 588 589 590 591 592 593 594 595

void StructureScanComplexItem::_validateEntryVertex(void)
{
    if (_entryVertex >= _flightPolygon.count()) {
        _entryVertex = 0;
        emit coordinateChanged(coordinate());
        emit exitCoordinateChanged(exitCoordinate());
    }
}