MeasurementComplexItem.cc 24.2 KB
Newer Older
Valentin Platzgummer's avatar
Valentin Platzgummer committed
1
#include "MeasurementComplexItem.h"
2 3 4

#include "CircularGenerator.h"
#include "LinearGenerator.h"
5
#include "RoutingThread.h"
6 7 8 9 10 11 12
#include "geometry/GenericCircle.h"
#include "geometry/MeasurementArea.h"
#include "geometry/SafeArea.h"
#include "geometry/clipper/clipper.hpp"
#include "geometry/snake.h"
#include "nemo_interface/SnakeTile.h"

13 14
// QGC
#include "JsonHelper.h"
Valentin Platzgummer's avatar
Valentin Platzgummer committed
15
#include "PlanMasterController.h"
16 17 18 19 20 21 22
#include "QGCApplication.h"
#include "QGCLoggingCategory.h"

// boost
#include <boost/units/io.hpp>
#include <boost/units/systems/si.hpp>

23
#define CLIPPER_SCALE 1000000
24

Valentin Platzgummer's avatar
Valentin Platzgummer committed
25
QGC_LOGGING_CATEGORY(MeasurementComplexItemLog, "MeasurementComplexItemLog")
26 27 28 29 30 31

template <typename T>
constexpr typename std::underlying_type<T>::type integral(T value) {
  return static_cast<typename std::underlying_type<T>::type>(value);
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
32 33 34 35 36 37 38 39 40 41 42 43 44
const char *MeasurementComplexItem::settingsGroup = "MeasurementComplexItem";
const char *MeasurementComplexItem::jsonComplexItemTypeValue =
    "MeasurementComplexItem";
const char *MeasurementComplexItem::variantName = "Variant";
const char *MeasurementComplexItem::altitudeName = "Altitude";
const QString MeasurementComplexItem::name(tr("Measurement"));

MeasurementComplexItem::MeasurementComplexItem(
    PlanMasterController *masterController, bool flyView,
    const QString &kmlOrShpFile, QObject *parent)
    : ComplexMissionItem(masterController, flyView, settingsGroup, parent),
      _masterController(masterController), _sequenceNumber(0),
      _followTerrain(false), _state(STATE::IDLE),
45
      _metaDataMap(FactMetaData::createMapFromJsonFile(
Valentin Platzgummer's avatar
Valentin Platzgummer committed
46 47
          QStringLiteral(":/json/MeasurementComplexItem.SettingsGroup.json"),
          this)),
48
      _variant(settingsGroup, _metaDataMap[variantName]),
Valentin Platzgummer's avatar
Valentin Platzgummer committed
49
      _variant(settingsGroup, _metaDataMap[altitudeName]),
50 51
      _areaData(new AreaData(this)), _editorData(new AreaData(this)),
      _currentData(_areaData), _pWorker(new RoutingThread(this)) {
52 53

  Q_UNUSED(kmlOrShpFile)
Valentin Platzgummer's avatar
Valentin Platzgummer committed
54
  _editorQml = "qrc:/qml/MeasurementItemEditor.qml";
55 56 57

  // Connect facts.
  connect(&this->_variant, &Fact::rawValueChanged, this,
Valentin Platzgummer's avatar
Valentin Platzgummer committed
58
          &MeasurementComplexItem::_changeVariant);
59 60

  // Connect worker.
61
  connect(this->_pWorker, &RoutingThread::result, this,
Valentin Platzgummer's avatar
Valentin Platzgummer committed
62
          &MeasurementComplexItem::_setTransects);
63
  connect(this->_pWorker, &RoutingThread::calculatingChanged, this,
Valentin Platzgummer's avatar
Valentin Platzgummer committed
64
          &MeasurementComplexItem::calculatingChanged);
65 66

  // Register Generators.
67
  auto lg = new routing::LinearGenerator(this->_areaData, this);
68
  registerGenerator(lg->name(), lg);
69
  auto cg = new routing::CircularGenerator(this->_areaData, this);
70
  registerGenerator(cg->name(), cg);
Valentin Platzgummer's avatar
Valentin Platzgummer committed
71 72 73

  qCritical() << "ToDo: _altitude connections missing.";
  qCritical() << "ToDo: add generator saveing.";
74 75
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
76
MeasurementComplexItem::~MeasurementComplexItem() {}
77

Valentin Platzgummer's avatar
Valentin Platzgummer committed
78
void MeasurementComplexItem::revertPath() {
79
  this->_setState(STATE::REVERT_PATH);
Valentin Platzgummer's avatar
Valentin Platzgummer committed
80
  this->_update();
81 82
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
83
const AreaData *MeasurementComplexItem::areaData() const {
84
  return this->_currentData;
85 86
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
87
AreaData *MeasurementComplexItem::areaData() { return this->_currentData; }
88

Valentin Platzgummer's avatar
Valentin Platzgummer committed
89 90 91
QStringList MeasurementComplexItem::variantNames() const {
  return _variantNames;
}
92

Valentin Platzgummer's avatar
Valentin Platzgummer committed
93 94
bool MeasurementComplexItem::load(const QJsonObject &complexObject,
                                  int sequenceNumber, QString &errorString) {
95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114
  // We need to pull version first to determine what validation/conversion
  // needs to be performed
  QList<JsonHelper::KeyValidateInfo> versionKeyInfoList = {
      {JsonHelper::jsonVersionKey, QJsonValue::Double, true},
  };
  if (!JsonHelper::validateKeys(complexObject, versionKeyInfoList,
                                errorString)) {
    return false;
  }

  int version = complexObject[JsonHelper::jsonVersionKey].toInt();
  if (version != 1) {
    errorString = tr("Survey items do not support version %1").arg(version);
    return false;
  }

  QList<JsonHelper::KeyValidateInfo> keyInfoList = {
      {VisualMissionItem::jsonTypeKey, QJsonValue::String, true},
      {ComplexMissionItem::jsonComplexItemTypeKey, QJsonValue::String, true},
      {variantName, QJsonValue::Double, false},
Valentin Platzgummer's avatar
Valentin Platzgummer committed
115
      {altitudeName, QJsonValue::Double, true},
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 144 145 146 147 148 149 150
  };

  if (!JsonHelper::validateKeys(complexObject, keyInfoList, errorString)) {
    return false;
  }

  QString itemType = complexObject[VisualMissionItem::jsonTypeKey].toString();
  QString complexType =
      complexObject[ComplexMissionItem::jsonComplexItemTypeKey].toString();
  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;
  }

  _ignoreRecalc = true;

  setSequenceNumber(sequenceNumber);

  if (!_surveyAreaPolygon.loadFromJson(complexObject, true /* required */,
                                       errorString)) {
    _surveyAreaPolygon.clear();
    return false;
  }

  if (!load(complexObject, sequenceNumber, errorString)) {
    _ignoreRecalc = false;
    return false;
  }

  _variant.setRawValue(complexObject[variantName].toInt());
Valentin Platzgummer's avatar
Valentin Platzgummer committed
151
  _altitude.setRawValue(complexObject[altitudeName].toDouble());
152 153 154 155 156 157 158 159 160 161 162

  _ignoreRecalc = false;

  if (_cameraShots == 0) {
    // Shot count was possibly not available from plan file
    _recalcCameraShots();
  }

  return true;
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
163 164 165 166 167 168 169 170
bool MeasurementComplexItem::dirty() const { return _dirty; }

bool MeasurementComplexItem::isSimpleItem() const { return false; }

bool MeasurementComplexItem::isStandaloneCoordinate() const { return false; }

QString MeasurementComplexItem::mapVisualQML() const {
  return QStringLiteral("MeasurementItemMapVisual.qml");
171 172
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
173
void MeasurementComplexItem::save(QJsonArray &planItems) {
174 175 176 177 178 179 180 181 182 183 184
  QJsonObject saveObject;

  _save(saveObject);

  saveObject[JsonHelper::jsonVersionKey] = 1;
  saveObject[VisualMissionItem::jsonTypeKey] =
      VisualMissionItem::jsonTypeComplexItemValue;
  saveObject[ComplexMissionItem::jsonComplexItemTypeKey] =
      jsonComplexItemTypeValue;

  saveObject[variantName] = double(_variant.rawValue().toUInt());
Valentin Platzgummer's avatar
Valentin Platzgummer committed
185
  saveObject[altitudeName] = double(_altitude.rawValue().toUInt());
186 187 188 189 190 191 192

  // Polygon shape
  _surveyAreaPolygon.saveToJson(saveObject);

  planItems.append(saveObject);
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265
double MeasurementComplexItem::amslEntryAlt() const {
  return _altitude.rawValue().toDouble() +
         this->_masterController->missionController()
             ->plannedHomePosition()
             .altitude();
}

double MeasurementComplexItem::amslExitAlt() const { return amslEntryAlt(); }

double MeasurementComplexItem::minAMSLAltitude() const {
  return amslEntryAlt();
}

double MeasurementComplexItem::maxAMSLAltitude() const {
  return amslEntryAlt();
}

bool MeasurementComplexItem::specifiesCoordinate() const {
  return _route.count() > 0;
}

bool MeasurementComplexItem::specifiesAltitudeOnly() const { return false; }

QGeoCoordinate MeasurementComplexItem::coordinate() const {
  return this->_route.size() > 0 ? _route.first() : QGeoCoordinate();
}

QGeoCoordinate MeasurementComplexItem::exitCoordinate() const {
  return this->_route.size() > 0 ? _route.last() : QGeoCoordinate();
}

int MeasurementComplexItem::sequenceNumber() const { return _sequenceNumber; }

double MeasurementComplexItem::specifiedFlightSpeed() {
  return std::numeric_limits<double>::quiet_NaN();
}

double MeasurementComplexItem::specifiedGimbalYaw() {
  return std::numeric_limits<double>::quiet_NaN();
}

double MeasurementComplexItem::specifiedGimbalPitch() {
  return std::numeric_limits<double>::quiet_NaN();
}

void MeasurementComplexItem::appendMissionItems(QList<MissionItem *> &items,
                                                QObject *missionItemParent) {
  qCDebug(MeasurementComplexItemLog) << "appendMissionItems()";

  int seqNum = this->_sequenceNumber;

  MAV_FRAME mavFrame =
      followTerrain() ? MAV_FRAME_GLOBAL : MAV_FRAME_GLOBAL_RELATIVE_ALT;

  int transectIndex = 0;
  for (const auto &vertex : this->_route) {
    MissionItem *item = new MissionItem(
        seqNum++, MAV_CMD_NAV_WAYPOINT, mavFrame,
        0,   // hold time
        0.0, // No acceptance radius specified
        0.0, // Pass through waypoint
        std::numeric_limits<double>::quiet_NaN(), // Yaw unchanged
        vertex.latitude(), vertex.longitude(), vertex.altitude(),
        true,  // autoContinue
        false, // isCurrentItem
        missionItemParent);
    items.append(item);
  }
}

void MeasurementComplexItem::setMissionFlightStatus(
    const MissionController::MissionFlightStatus_t &missionFlightStatus) {
  ComplexMissionItem::setMissionFlightStatus(missionFlightStatus);
266 267
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
268 269 270 271 272 273 274
void MeasurementComplexItem::applyNewAltitude(double newAltitude) {
  this->_altitude->setRawValue(newAltitude);
}

double MeasurementComplexItem::additionalTimeDelay() const { return 0; }

bool MeasurementComplexItem::_setGenerator(PtrGenerator newG) {
275 276
  if (this->_pGenerator != newG) {
    if (this->_pGenerator != nullptr) {
277
      disconnect(this->_pGenerator, &routing::GeneratorBase::generatorChanged,
Valentin Platzgummer's avatar
Valentin Platzgummer committed
278
                 this, &MeasurementComplexItem::_update);
279 280 281
    }

    this->_pGenerator = newG;
282
    connect(this->_pGenerator, &routing::GeneratorBase::generatorChanged, this,
Valentin Platzgummer's avatar
Valentin Platzgummer committed
283
            &MeasurementComplexItem::_update);
284 285 286
    emit generatorChanged();

    this->_setState(STATE::IDLE);
Valentin Platzgummer's avatar
Valentin Platzgummer committed
287
    _update();
288 289 290 291 292 293 294

    return true;
  } else {
    return false;
  }
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
295
void MeasurementComplexItem::_setState(MeasurementComplexItem::STATE state) {
296 297 298
  if (this->_state != state) {
    auto oldState = this->_state;
    this->_state = state;
Valentin Platzgummer's avatar
Valentin Platzgummer committed
299

300 301 302
    if (_calculating(oldState) != _calculating(state)) {
      emit calculatingChanged();
    }
Valentin Platzgummer's avatar
Valentin Platzgummer committed
303 304 305 306

    if (_editing(oldState) != _editing(state)) {
      emit editingChanged();
    }
307 308 309
  }
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
310 311
bool MeasurementComplexItem::_calculating(
    MeasurementComplexItem::STATE state) const {
312 313 314
  return state == STATE::ROUTING;
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
315 316
void MeasurementComplexItem::_setAreaData(
    MeasurementComplexItem::PtrAreaData data) {
317 318 319 320 321 322
  if (_currentData != data) {
    _currentData = data;
    emit areaDataChanged();
  }
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
323
void MeasurementComplexItem::_changeVariant() {
324
  this->_setState(STATE::CHANGE_VARIANT);
Valentin Platzgummer's avatar
Valentin Platzgummer committed
325
  this->_update();
326 327
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
328
bool MeasurementComplexItem::_updateRouteWorker() {
329 330 331 332 333 334 335 336 337 338 339 340
  // Reset data.
  this->_transects.clear();
  this->_variantVector.clear();
  this->_variantNames.clear();
  emit variantNamesChanged();

  if (this->_areaData->isValid()) {

    // Prepare data.
    auto origin = this->_areaData->origin();
    origin.setAltitude(0);
    if (!origin.isValid()) {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
341
      qCDebug(MeasurementComplexItemLog)
342 343 344 345 346
          << "_updateWorker(): origin invalid." << origin;
      return false;
    }

    // Convert safe area.
347 348 349
    auto serviceArea =
        getGeoArea<const SafeArea *>(*this->_areaData->areaList());
    auto geoSafeArea = serviceArea->coordinateList();
350
    if (!(geoSafeArea.size() >= 3)) {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
351
      qCDebug(MeasurementComplexItemLog)
352 353 354 355 356 357 358
          << "_updateWorker(): safe area invalid." << geoSafeArea;
      return false;
    }
    for (auto &v : geoSafeArea) {
      if (v.isValid()) {
        v.setAltitude(0);
      } else {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
359
        qCDebug(MeasurementComplexItemLog)
360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379
            << "_updateWorker(): safe area contains invalid coordinate."
            << geoSafeArea;
        return false;
      }
    }

    // Routing par.
    RoutingParameter par;
    par.numSolutions = 5;
    auto &safeAreaENU = par.safeArea;
    snake::areaToEnu(origin, geoSafeArea, safeAreaENU);

    // Create generator.
    if (this->_pGenerator) {
      routing::GeneratorBase::Generator g; // Transect generator.
      if (this->_pGenerator->get(g)) {
        // Start/Restart routing worker.
        this->_pWorker->route(par, g);
        return true;
      } else {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
380
        qCDebug(MeasurementComplexItemLog)
381 382 383 384
            << "_updateWorker(): generator creation failed.";
        return false;
      }
    } else {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
385
      qCDebug(MeasurementComplexItemLog)
386 387 388 389 390 391
          << "_updateWorker(): pGenerator == nullptr, number of registered "
             "generators: "
          << this->_generatorList.size();
      return false;
    }
  } else {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
392
    qCDebug(MeasurementComplexItemLog) << "_updateWorker(): plan data invalid.";
393 394 395 396
    return false;
  }
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
397
void MeasurementComplexItem::_changeVariantWorker() {
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
  auto variant = this->_variant.rawValue().toUInt();

  // Find old variant and run. Old run corresponts with empty list.
  std::size_t old_variant = std::numeric_limits<std::size_t>::max();
  for (std::size_t i = 0; i < std::size_t(this->_variantVector.size()); ++i) {
    const auto &variantCoordinates = this->_variantVector.at(i);
    if (variantCoordinates.isEmpty()) {
      old_variant = i;
      break;
    }
  }

  // Swap route.
  if (variant != old_variant) {
    // Swap in new variant.
    if (variant < std::size_t(this->_variantVector.size())) {
      if (old_variant != std::numeric_limits<std::size_t>::max()) {
        // this->_transects containes a route, swap it back to
        // this->_solutionVector
        auto &oldVariantCoordinates = this->_variantVector[old_variant];
        oldVariantCoordinates.swap(this->_transects);
      }
      auto &newVariantCoordinates = this->_variantVector[variant];
      this->_transects.swap(newVariantCoordinates);

    } else { // error
Valentin Platzgummer's avatar
Valentin Platzgummer committed
424
      qCDebug(MeasurementComplexItemLog)
425
          << "Variant out of bounds (variant =" << variant << ").";
Valentin Platzgummer's avatar
Valentin Platzgummer committed
426
      qCDebug(MeasurementComplexItemLog) << "Resetting variant to zero.";
427 428

      disconnect(&this->_variant, &Fact::rawValueChanged, this,
Valentin Platzgummer's avatar
Valentin Platzgummer committed
429
                 &MeasurementComplexItem::_changeVariant);
430 431
      this->_variant.setCookedValue(QVariant(0));
      connect(&this->_variant, &Fact::rawValueChanged, this,
Valentin Platzgummer's avatar
Valentin Platzgummer committed
432
              &MeasurementComplexItem::_changeVariant);
433 434 435 436 437 438 439 440

      if (this->_variantVector.size() > 0) {
        this->_changeVariantWorker();
      }
    }
  }
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
441
void MeasurementComplexItem::_reverseWorker() {
442 443 444 445 446 447
  if (this->_transects.size() > 0) {
    auto &t = this->_transects.front();
    std::reverse(t.begin(), t.end());
  }
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
448
double MeasurementComplexItem::timeBetweenShots() { return 0; }
449

Valentin Platzgummer's avatar
Valentin Platzgummer committed
450 451 452
QString MeasurementComplexItem::commandDescription() const {
  return tr("Route");
}
453

Valentin Platzgummer's avatar
Valentin Platzgummer committed
454
QString MeasurementComplexItem::commandName() const { return tr("Route"); }
455

Valentin Platzgummer's avatar
Valentin Platzgummer committed
456
QString MeasurementComplexItem::abbreviation() const { return tr("R"); }
457 458

TransectStyleComplexItem::ReadyForSaveState
Valentin Platzgummer's avatar
Valentin Platzgummer committed
459
MeasurementComplexItem::readyForSaveState() const {
460 461 462 463 464 465 466 467 468 469 470 471
  if (TransectStyleComplexItem::readyForSaveState() ==
      TransectStyleComplexItem::ReadyForSaveState::ReadyForSave) {
    if (this->_state == STATE::IDLE) {
      return ReadyForSaveState::ReadyForSave;
    } else {
      return ReadyForSaveState::NotReadyForSaveData;
    }
  } else {
    return TransectStyleComplexItem::readyForSaveState();
  }
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
472 473 474 475
bool MeasurementComplexItem::exitCoordinateSameAsEntry() const {
  return this->_route.size() > 0 ? this->_route.first() == this->_route.last()
                                 : false;
}
476

Valentin Platzgummer's avatar
Valentin Platzgummer committed
477 478 479 480 481 482
void MeasurementComplexItem::setDirty(bool dirty) {
  if (this->_dirty != dirty) {
    this->_dirty = dirty;
    emit dirtyChanged(this->_dirty);
  }
}
483

Valentin Platzgummer's avatar
Valentin Platzgummer committed
484 485 486 487 488 489 490 491 492 493 494 495 496 497 498
void MeasurementComplexItem::setCoordinate(const QGeoCoordinate &coordinate) {
  Q_UNUSED(coordinate);
}

void MeasurementComplexItem::setSequenceNumber(int sequenceNumber) {
  if (this->_sequenceNumber != sequenceNumber) {
    this->_sequenceNumber = sequenceNumber;
    emit sequenceNumberChanged(this->_sequenceNumber);
  }
}

QString MeasurementComplexItem::patternName() const { return name; }

bool MeasurementComplexItem::registerGenerator(const QString &name,
                                               routing::GeneratorBase *g) {
499
  if (name.isEmpty()) {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
500 501
    qCDebug(MeasurementComplexItemLog)
        << "registerGenerator(): empty name string.";
502 503 504 505
    return false;
  }

  if (!g) {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
506 507
    qCDebug(MeasurementComplexItemLog)
        << "registerGenerator(): empty generator.";
508 509 510 511
    return false;
  }

  if (this->_generatorNameList.contains(name)) {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
512 513
    qCDebug(MeasurementComplexItemLog) << "registerGenerator(): generator "
                                          "already registered.";
514 515 516 517 518
    return false;
  } else {
    this->_generatorNameList.push_back(name);
    this->_generatorList.push_back(g);
    if (this->_generatorList.size() == 1) {
519
      _setGenerator(g);
520 521 522 523 524 525 526
    }

    emit generatorNameListChanged();
    return true;
  }
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
527
bool MeasurementComplexItem::unregisterGenerator(const QString &name) {
528 529 530 531 532 533
  auto index = this->_generatorNameList.indexOf(name);
  if (index >= 0) {
    // Is this the current generator?
    const auto &g = this->_generatorList.at(index);
    if (g == this->_pGenerator) {
      if (index > 0) {
534
        _setGenerator(this->_generatorList.at(index - 1));
535
      } else {
536
        _setGenerator(nullptr);
Valentin Platzgummer's avatar
Valentin Platzgummer committed
537
        qCDebug(MeasurementComplexItemLog)
538 539 540 541 542
            << "unregisterGenerator(): last generator unregistered.";
      }
    }

    this->_generatorNameList.removeAt(index);
543 544
    auto gen = this->_generatorList.takeAt(index);
    gen->deleteLater();
545 546 547 548

    emit generatorNameListChanged();
    return true;
  } else {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
549
    qCDebug(MeasurementComplexItemLog)
550 551 552 553 554
        << "unregisterGenerator(): generator " << name << " not registered.";
    return false;
  }
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
555
bool MeasurementComplexItem::unregisterGenerator(int index) {
556 557 558
  if (index > 0 && index < this->_generatorNameList.size()) {
    return unregisterGenerator(this->_generatorNameList.at(index));
  } else {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
559 560 561 562 563
    qCDebug(MeasurementComplexItemLog)
        << "unregisterGenerator(): index (" << index
        << ") out"
           "of bounds ( "
        << this->_generatorList.size() << " ).";
564 565 566 567
    return false;
  }
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
568
bool MeasurementComplexItem::switchToGenerator(const QString &name) {
569 570
  auto index = this->_generatorNameList.indexOf(name);
  if (index >= 0) {
571
    _setGenerator(this->_generatorList.at(index));
572 573
    return true;
  } else {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
574
    qCDebug(MeasurementComplexItemLog)
575 576 577 578 579
        << "switchToGenerator(): generator " << name << " not registered.";
    return false;
  }
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
580
bool MeasurementComplexItem::switchToGenerator(int index) {
581
  if (index >= 0) {
582
    _setGenerator(this->_generatorList.at(index));
583 584
    return true;
  } else {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
585 586 587 588 589
    qCDebug(MeasurementComplexItemLog)
        << "unregisterGenerator(): index (" << index
        << ") out"
           "of bounds ( "
        << this->_generatorNameList.size() << " ).";
590 591 592 593
    return false;
  }
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
594
QStringList MeasurementComplexItem::generatorNameList() {
595 596 597
  return this->_generatorNameList;
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
598 599 600
routing::GeneratorBase *MeasurementComplexItem::generator() {
  return _pGenerator;
}
601

Valentin Platzgummer's avatar
Valentin Platzgummer committed
602
int MeasurementComplexItem::generatorIndex() {
603 604 605
  return this->_generatorList.indexOf(this->_pGenerator);
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
606 607
void MeasurementComplexItem::editingStart() {
  if (!_editing(this->_state)) {
608 609
    *_editorData = *_areaData;
    _setAreaData(_editorData);
Valentin Platzgummer's avatar
Valentin Platzgummer committed
610
    _setState(STATE::EDITING);
611 612 613
  }
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
614 615
void MeasurementComplexItem::editingStop() {
  if (_editing(this->_state)) {
616 617 618 619
    if (_editorData->isValid()) {
      *_areaData = *_editorData;
    }
    _setAreaData(_areaData);
Valentin Platzgummer's avatar
Valentin Platzgummer committed
620
    _setState(STATE::IDLE);
621 622 623
  }
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
624
void MeasurementComplexItem::_update(void) {
625 626 627 628
  auto start = std::chrono::high_resolution_clock::now();

  switch (this->_state) {
  case STATE::SKIPP:
Valentin Platzgummer's avatar
Valentin Platzgummer committed
629
    qCDebug(MeasurementComplexItemLog) << "rebuildTransectsPhase1: skipp.";
630 631 632
    this->_setState(STATE::IDLE);
    break;
  case STATE::CHANGE_VARIANT:
Valentin Platzgummer's avatar
Valentin Platzgummer committed
633 634
    qCDebug(MeasurementComplexItemLog)
        << "rebuildTransectsPhase1: variant change.";
635 636 637 638
    this->_changeVariantWorker();
    this->_setState(STATE::IDLE);
    break;
  case STATE::REVERT_PATH:
Valentin Platzgummer's avatar
Valentin Platzgummer committed
639
    qCDebug(MeasurementComplexItemLog) << "rebuildTransectsPhase1: reverse.";
640 641 642 643 644 645
    this->_reverseWorker();
    this->_setState(STATE::IDLE);
    break;
  case STATE::IDLE:
  case STATE::ROUTING:
    this->_setState(STATE::ROUTING);
Valentin Platzgummer's avatar
Valentin Platzgummer committed
646 647
    qCDebug(MeasurementComplexItemLog) << "rebuildTransectsPhase1: update.";
    if (!this->_updateRouteWorker()) {
648 649 650 651 652
      this->_setState(STATE::IDLE);
    }
    break;
  }

Valentin Platzgummer's avatar
Valentin Platzgummer committed
653
  qCDebug(MeasurementComplexItemLog)
654 655 656 657 658 659 660
      << "rebuildTransectsPhase1(): "
      << std::chrono::duration_cast<std::chrono::milliseconds>(
             std::chrono::high_resolution_clock::now() - start)
             .count()
      << " ms";
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
661
void MeasurementComplexItem::_recalcCameraShots() { _cameraShots = 0; }
662

Valentin Platzgummer's avatar
Valentin Platzgummer committed
663 664
void MeasurementComplexItem::_setTransects(
    MeasurementComplexItem::PtrRoutingData pRoute) {
665 666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709 710 711 712 713 714 715 716 717 718 719 720
  // Store solutions.
  auto ori = this->_areaData->origin();
  ori.setAltitude(0);
  const auto &transectsENU = pRoute->transects;
  QVector<Variant> variantVector;
  const auto nSolutions = pRoute->solutionVector.size();

  for (std::size_t j = 0; j < nSolutions; ++j) {
    Variant var{QList<CoordInfo_t>()};
    const auto &solution = pRoute->solutionVector.at(j);
    if (solution.size() > 0) {
      const auto &route = solution.at(0);
      const auto &path = route.path;
      const auto &info = route.info;
      if (info.size() > 1) {
        // Find index of first waypoint.
        std::size_t idxFirst = 0;
        const auto &infoFirst = info.at(1);
        const auto &firstTransect = transectsENU[infoFirst.index];
        if (firstTransect.size() > 0) {
          const auto &firstWaypoint =
              infoFirst.reversed ? firstTransect.back() : firstTransect.front();
          double th = 0.01;
          for (std::size_t i = 0; i < path.size(); ++i) {
            auto dist = bg::distance(path[i], firstWaypoint);
            if (dist < th) {
              idxFirst = i;
              break;
            }
          }

          // Find index of last waypoint.
          std::size_t idxLast = path.size() - 1;
          const auto &infoLast = info.at(info.size() - 2);
          const auto &lastTransect = transectsENU[infoLast.index];
          if (lastTransect.size() > 0) {
            const auto &lastWaypoint =
                infoLast.reversed ? lastTransect.front() : lastTransect.back();
            for (long i = path.size() - 1; i >= 0; --i) {
              auto dist = bg::distance(path[i], lastWaypoint);
              if (dist < th) {
                idxLast = i;
                break;
              }
            }

            // Convert to geo coordinates.
            auto &list = var.front();
            for (std::size_t i = idxFirst; i <= idxLast; ++i) {
              auto &vertex = path[i];
              QGeoCoordinate c;
              snake::fromENU(ori, vertex, c);
              list.append(CoordInfo_t{c, CoordTypeInterior});
            }

          } else {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
721
            qCDebug(MeasurementComplexItemLog)
722 723 724
                << "_setTransects(): lastTransect.size() == 0";
          }
        } else {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
725
          qCDebug(MeasurementComplexItemLog)
726 727 728
              << "_setTransects(): firstTransect.size() == 0";
        }
      } else {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
729
        qCDebug(MeasurementComplexItemLog)
730 731 732
            << "_setTransects(): transectsInfo.size() <= 1";
      }
    } else {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
733 734
      qCDebug(MeasurementComplexItemLog)
          << "_setTransects(): solution.size() == 0";
735 736 737 738 739 740 741 742 743 744 745 746 747 748 749 750 751 752 753 754 755 756 757 758 759 760 761 762 763
    }

    if (var.size() > 0 && var.front().size() > 0) {
      variantVector.push_back(std::move(var));
    }
  }

  // Assign routes if no error occured.
  if (variantVector.size() > 0) {
    // Swap first route to _transects.
    this->_variantVector.swap(variantVector);

    // If the transects are getting rebuilt then any previously loaded
    // mission items are now invalid.
    if (_loadedMissionItemsParent) {
      _loadedMissionItems.clear();
      _loadedMissionItemsParent->deleteLater();
      _loadedMissionItemsParent = nullptr;
    }

    // Add route variant names.
    this->_variantNames.clear();
    for (std::size_t i = 1; i <= std::size_t(this->_variantVector.size());
         ++i) {
      this->_variantNames.append(QString::number(i));
    }
    emit variantNamesChanged();

    disconnect(&this->_variant, &Fact::rawValueChanged, this,
Valentin Platzgummer's avatar
Valentin Platzgummer committed
764
               &MeasurementComplexItem::_changeVariant);
765 766
    this->_variant.setCookedValue(QVariant(0));
    connect(&this->_variant, &Fact::rawValueChanged, this,
Valentin Platzgummer's avatar
Valentin Platzgummer committed
767
            &MeasurementComplexItem::_changeVariant);
768 769 770
    this->_changeVariantWorker();

    this->_setState(STATE::SKIPP);
Valentin Platzgummer's avatar
Valentin Platzgummer committed
771
    this->_update();
772
  } else {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
773
    qCDebug(MeasurementComplexItemLog)
774 775 776 777 778
        << "_setTransects(): failed, variantVector empty.";
    this->_setState(STATE::IDLE);
  }
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
779 780 781
Fact *MeasurementComplexItem::variant() { return &_variant; }

Fact *MeasurementComplexItem::altitude() { return &this->_altitude; }
782

Valentin Platzgummer's avatar
Valentin Platzgummer committed
783
bool MeasurementComplexItem::calculating() const {
784 785 786
  return this->_calculating(this->_state);
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
787 788 789
bool MeasurementComplexItem::editing() const { return _editing(this->_state); }

bool MeasurementComplexItem::followTerrain() const { return _followTerrain; }