MeasurementComplexItem.cc 24.3 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
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)
Valentin Platzgummer's avatar
Valentin Platzgummer committed
42
    : ComplexMissionItem(masterController, flyView, parent),
Valentin Platzgummer's avatar
Valentin Platzgummer committed
43
      _masterController(masterController), _sequenceNumber(0),
44
      _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
      _altitude(settingsGroup, _metaDataMap[altitudeName]),
49
      _variant(settingsGroup, _metaDataMap[variantName]),
50 51 52
      _pAreaData(new AreaData(this)), _pEditorData(new AreaData(this)),
      _pCurrentData(_pAreaData), _pGenerator(nullptr),
      _pWorker(new RoutingThread(this)) {
53 54

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

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

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

65
  // Connect coordinate and exitCoordinate.
Valentin Platzgummer's avatar
Valentin Platzgummer committed
66 67 68 69 70 71 72 73
  connect(this, &MeasurementComplexItem::routeChanged,
          [this] { emit this->coordinateChanged(this->coordinate()); });
  connect(this, &MeasurementComplexItem::routeChanged,
          [this] { emit this->exitCoordinateChanged(this->exitCoordinate()); });
  connect(this, &MeasurementComplexItem::routeChanged, [this] {
    emit this->exitCoordinateSameAsEntryChanged(
        this->exitCoordinateSameAsEntry());
  });
74

75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91
  // Connect isIncomplete.
  connect(this, &MeasurementComplexItem::idleChanged, [this] {
    if (this->idle()) {
      if (this->route().size() > 0 && this->_isIncomplete == true) {
        this->_isIncomplete = false;
        emit this->isIncompleteChanged();
      }
    } else {
      if (this->_isIncomplete == false) {
        this->_isIncomplete = true;
        emit this->isIncompleteChanged();
      }
    }
  });
  connect(this, &MeasurementComplexItem::idleChanged, this,
          &MeasurementComplexItem::readyForSaveStateChanged);

92 93 94 95
  // Connect complexDistance.
  connect(this, &MeasurementComplexItem::routeChanged,
          [this] { emit this->complexDistanceChanged(); });

96
  // Register Generators.
97
  auto lg = new routing::LinearGenerator(this->_pAreaData, this);
98
  addGenerator(lg->name(), lg);
99
  auto cg = new routing::CircularGenerator(this->_pAreaData, this);
100
  addGenerator(cg->name(), cg);
Valentin Platzgummer's avatar
Valentin Platzgummer committed
101 102 103

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

Valentin Platzgummer's avatar
Valentin Platzgummer committed
106
MeasurementComplexItem::~MeasurementComplexItem() {}
107

Valentin Platzgummer's avatar
Valentin Platzgummer committed
108
void MeasurementComplexItem::reverseRoute() { _reverseRoute(); }
109

Valentin Platzgummer's avatar
Valentin Platzgummer committed
110
const AreaData *MeasurementComplexItem::areaData() const {
111
  return this->_pCurrentData;
112 113
}

114
AreaData *MeasurementComplexItem::areaData() { return this->_pCurrentData; }
115

Valentin Platzgummer's avatar
Valentin Platzgummer committed
116 117
QVariantList MeasurementComplexItem::route() { return _route; }

Valentin Platzgummer's avatar
Valentin Platzgummer committed
118 119 120
QStringList MeasurementComplexItem::variantNames() const {
  return _variantNames;
}
121

Valentin Platzgummer's avatar
Valentin Platzgummer committed
122 123
bool MeasurementComplexItem::load(const QJsonObject &complexObject,
                                  int sequenceNumber, QString &errorString) {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
124 125 126 127
  qWarning() << "MeasurementComplexItem::load(): area data load missing.";
  qWarning() << "MeasurementComplexItem::load(): mission item load missing.";
  qWarning() << "MeasurementComplexItem::load(): add editingStart/Stop.";

128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147
  // 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
148
      {altitudeName, QJsonValue::Double, true},
149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174
  };

  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;
  }

  setSequenceNumber(sequenceNumber);

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

  _variant.setRawValue(complexObject[variantName].toInt());
Valentin Platzgummer's avatar
Valentin Platzgummer committed
175
  _altitude.setRawValue(complexObject[altitudeName].toDouble());
176 177 178 179

  return true;
}

180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197
double
MeasurementComplexItem::greatestDistanceTo(const QGeoCoordinate &other) const {
  double d = -1 * std::numeric_limits<double>::infinity();
  if (other.isValid()) {
    if (this->_route.size() > 0) {
      std::for_each(this->_route.cbegin(), this->_route.cend(),
                    [&d, &other](const QVariant &variant) {
                      auto vertex = variant.value<QGeoCoordinate>();
                      d = std::max(d, vertex.distanceTo(other));
                    });
    }
  } else {
    qCDebug(MeasurementComplexItemLog)
        << "greatestDistanceTo(): invalid QGeoCoordinate: " << other;
  }
  return d;
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
198 199 200 201 202 203 204 205
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");
206 207
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
208
void MeasurementComplexItem::save(QJsonArray &planItems) {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
209 210
  qWarning() << "MeasurementComplexItem::save(): area data save missing.";
  qWarning() << "MeasurementComplexItem::save(): mission item save missing.";
211

212
  if (idle()) {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
213
    QJsonObject saveObject;
214

Valentin Platzgummer's avatar
Valentin Platzgummer committed
215 216 217 218 219
    saveObject[JsonHelper::jsonVersionKey] = 1;
    saveObject[VisualMissionItem::jsonTypeKey] =
        VisualMissionItem::jsonTypeComplexItemValue;
    saveObject[ComplexMissionItem::jsonComplexItemTypeKey] =
        jsonComplexItemTypeValue;
220

Valentin Platzgummer's avatar
Valentin Platzgummer committed
221 222
    saveObject[variantName] = double(_variant.rawValue().toUInt());
    saveObject[altitudeName] = double(_altitude.rawValue().toUInt());
223

Valentin Platzgummer's avatar
Valentin Platzgummer committed
224 225
    planItems.append(saveObject);
  }
226 227
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244
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();
}

245 246 247 248 249 250 251 252 253 254 255 256
QString MeasurementComplexItem::commandDescription() const {
  return QStringLiteral("Measurement");
}

QString MeasurementComplexItem::commandName() const {
  return QStringLiteral("Measurement");
}

QString MeasurementComplexItem::abbreviation() const {
  return QStringLiteral("M");
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
257 258 259 260 261 262 263
bool MeasurementComplexItem::specifiesCoordinate() const {
  return _route.count() > 0;
}

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

QGeoCoordinate MeasurementComplexItem::coordinate() const {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
264 265
  return this->_route.size() > 0 ? _route.first().value<QGeoCoordinate>()
                                 : QGeoCoordinate();
Valentin Platzgummer's avatar
Valentin Platzgummer committed
266 267 268
}

QGeoCoordinate MeasurementComplexItem::exitCoordinate() const {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
269 270
  return this->_route.size() > 0 ? _route.last().value<QGeoCoordinate>()
                                 : QGeoCoordinate();
Valentin Platzgummer's avatar
Valentin Platzgummer committed
271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288
}

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) {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
289

290
  if (idle()) {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314
    qCDebug(MeasurementComplexItemLog) << "appendMissionItems()";

    int seqNum = this->_sequenceNumber;

    MAV_FRAME mavFrame =
        followTerrain() ? MAV_FRAME_GLOBAL : MAV_FRAME_GLOBAL_RELATIVE_ALT;

    for (const auto &variant : this->_route) {
      auto vertex = variant.value<QGeoCoordinate>();
      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);
    }
  } else {
    qCDebug(MeasurementComplexItemLog)
        << "appendMissionItems(): called while not ready().";
Valentin Platzgummer's avatar
Valentin Platzgummer committed
315 316 317 318 319 320
  }
}

void MeasurementComplexItem::setMissionFlightStatus(
    const MissionController::MissionFlightStatus_t &missionFlightStatus) {
  ComplexMissionItem::setMissionFlightStatus(missionFlightStatus);
321 322
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
323
void MeasurementComplexItem::applyNewAltitude(double newAltitude) {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
324 325
  this->_altitude.setRawValue(newAltitude);
  qWarning() << "applyNewAltitude(): impl. missing.";
Valentin Platzgummer's avatar
Valentin Platzgummer committed
326 327 328 329 330
}

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

bool MeasurementComplexItem::_setGenerator(PtrGenerator newG) {
331 332
  if (this->_pGenerator != newG) {
    if (this->_pGenerator != nullptr) {
333
      disconnect(this->_pGenerator, &routing::GeneratorBase::generatorChanged,
Valentin Platzgummer's avatar
Valentin Platzgummer committed
334
                 this, &MeasurementComplexItem::_updateRoute);
335 336 337
    }

    this->_pGenerator = newG;
338 339 340 341 342 343

    if (this->_pGenerator != nullptr) {
      connect(this->_pGenerator, &routing::GeneratorBase::generatorChanged,
              this, &MeasurementComplexItem::_updateRoute);
    }

344 345
    emit generatorChanged();

Valentin Platzgummer's avatar
Valentin Platzgummer committed
346 347 348 349
    if (!editing()) {
      this->_setState(STATE::IDLE);
      _updateRoute();
    }
350 351 352 353 354 355 356

    return true;
  } else {
    return false;
  }
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
357
void MeasurementComplexItem::_setState(MeasurementComplexItem::STATE state) {
358 359 360
  if (this->_state != state) {
    auto oldState = this->_state;
    this->_state = state;
Valentin Platzgummer's avatar
Valentin Platzgummer committed
361

362 363 364
    if (_calculating(oldState) != _calculating(state)) {
      emit calculatingChanged();
    }
Valentin Platzgummer's avatar
Valentin Platzgummer committed
365 366 367 368

    if (_editing(oldState) != _editing(state)) {
      emit editingChanged();
    }
Valentin Platzgummer's avatar
Valentin Platzgummer committed
369

370 371
    if (_idle(oldState) != _idle(state)) {
      emit idleChanged();
Valentin Platzgummer's avatar
Valentin Platzgummer committed
372
    }
373 374 375
  }
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
376
bool MeasurementComplexItem::_calculating(MeasurementComplexItem::STATE state) {
377 378 379
  return state == STATE::ROUTING;
}

380 381 382 383
bool MeasurementComplexItem::_editing(MeasurementComplexItem::STATE state) {
  return state == STATE::EDITING;
}

384
bool MeasurementComplexItem::_idle(MeasurementComplexItem::STATE state) {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
385 386 387
  return state == STATE::IDLE;
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
388 389
void MeasurementComplexItem::_setAreaData(
    MeasurementComplexItem::PtrAreaData data) {
390 391
  if (_pCurrentData != data) {
    _pCurrentData = data;
392 393 394 395
    emit areaDataChanged();
  }
}

396 397 398 399
void MeasurementComplexItem::_updateRoute() {
  if (!editing()) {
    // Reset data.
    this->_route.clear();
400
    emit routeChanged();
401 402 403 404 405 406 407 408 409 410
    this->_variantVector.clear();
    this->_variantNames.clear();
    emit variantNamesChanged();

    if (this->_pAreaData->isCorrect()) {

      // Prepare data.
      auto origin = this->_pAreaData->origin();
      origin.setAltitude(0);
      if (!origin.isValid()) {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
411
        qCDebug(MeasurementComplexItemLog)
412 413
            << "_updateWorker(): origin invalid." << origin;
        return;
414 415
      }

416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434
      // Convert safe area.
      auto serviceArea =
          getGeoArea<const SafeArea *>(*this->_pAreaData->areaList());
      auto geoSafeArea = serviceArea->coordinateList();
      if (!(geoSafeArea.size() >= 3)) {
        qCDebug(MeasurementComplexItemLog)
            << "_updateWorker(): safe area invalid." << geoSafeArea;
        return;
      }
      for (auto &v : geoSafeArea) {
        if (v.isValid()) {
          v.setAltitude(0);
        } else {
          qCDebug(MeasurementComplexItemLog)
              << "_updateWorker(): safe area contains invalid coordinate."
              << geoSafeArea;
          return;
        }
      }
435

436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454
      // Routing par.
      RoutingParameter par;
      par.numSolutions = 5;
      auto &safeAreaENU = par.safeArea;
      snake::areaToEnu(origin, geoSafeArea, safeAreaENU);

      // Create generator.
      if (this->_pGenerator != nullptr) {
        routing::GeneratorBase::Generator g; // Transect generator.
        if (this->_pGenerator->get(g)) {
          // Start/Restart routing worker.
          this->_pWorker->route(par, g);
          _setState(STATE::ROUTING);
          return;
        } else {
          qCDebug(MeasurementComplexItemLog)
              << "_updateWorker(): generator creation failed.";
          return;
        }
455
      } else {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
456
        qCDebug(MeasurementComplexItemLog)
457 458 459 460
            << "_updateWorker(): pGenerator == nullptr, number of registered "
               "generators: "
            << this->_generatorList.size();
        return;
461 462
      }
    } else {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
463
      qCDebug(MeasurementComplexItemLog)
464
          << "_updateWorker(): area data invalid.";
465
      return;
466 467 468 469
    }
  }
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
470
void MeasurementComplexItem::_changeVariant() {
471
  if (idle()) {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
472 473 474 475 476 477 478 479 480 481
    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;
      }
482 483
    }

Valentin Platzgummer's avatar
Valentin Platzgummer committed
484 485 486 487 488 489 490
    // 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->_route containes a route, swap it back to
          // this->_solutionVector
491 492
          auto &oldRoute = this->_variantVector[old_variant];
          oldRoute.swap(this->_route);
Valentin Platzgummer's avatar
Valentin Platzgummer committed
493
        }
494 495
        auto &newRoute = this->_variantVector[variant];
        this->_route.swap(newRoute);
496
        emit routeChanged();
Valentin Platzgummer's avatar
Valentin Platzgummer committed
497 498 499 500
      } else { // error
        qCDebug(MeasurementComplexItemLog)
            << "Variant out of bounds (variant =" << variant << ").";
        qCDebug(MeasurementComplexItemLog) << "Resetting variant to zero.";
501

Valentin Platzgummer's avatar
Valentin Platzgummer committed
502 503 504 505 506
        disconnect(&this->_variant, &Fact::rawValueChanged, this,
                   &MeasurementComplexItem::_changeVariant);
        this->_variant.setCookedValue(QVariant(0));
        connect(&this->_variant, &Fact::rawValueChanged, this,
                &MeasurementComplexItem::_changeVariant);
507

Valentin Platzgummer's avatar
Valentin Platzgummer committed
508 509 510
        if (this->_variantVector.size() > 0) {
          this->_changeVariant();
        }
511 512 513 514 515
      }
    }
  }
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
516
void MeasurementComplexItem::_reverseRoute() {
517
  if (idle()) {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
518 519 520 521
    if (this->_route.size() > 0) {
      auto &t = this->_route;
      std::reverse(t.begin(), t.end());
    }
522
    emit routeChanged();
523 524 525
  }
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
526
ComplexMissionItem::ReadyForSaveState
Valentin Platzgummer's avatar
Valentin Platzgummer committed
527
MeasurementComplexItem::readyForSaveState() const {
528
  if (idle()) {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
529
    return ReadyForSaveState::ReadyForSave;
530
  } else {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
531
    return ReadyForSaveState::NotReadyForSaveData;
532 533 534
  }
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
535 536 537 538
bool MeasurementComplexItem::exitCoordinateSameAsEntry() const {
  return this->_route.size() > 0 ? this->_route.first() == this->_route.last()
                                 : false;
}
539

Valentin Platzgummer's avatar
Valentin Platzgummer committed
540 541 542 543 544 545
void MeasurementComplexItem::setDirty(bool dirty) {
  if (this->_dirty != dirty) {
    this->_dirty = dirty;
    emit dirtyChanged(this->_dirty);
  }
}
546

Valentin Platzgummer's avatar
Valentin Platzgummer committed
547 548 549 550 551 552 553 554 555 556 557 558 559
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; }

560 561 562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 577
double MeasurementComplexItem::complexDistance() const {
  double d = 0;
  if (this->_route.size() > 1) {
    auto vertex = _route.first().value<QGeoCoordinate>();
    std::for_each(this->_route.cbegin() + 1, this->_route.cend(),
                  [&vertex, &d](const QVariant &variant) {
                    auto otherVertex = variant.value<QGeoCoordinate>();
                    d += vertex.distanceTo(otherVertex);
                    vertex = otherVertex;
                  });
  }
  return d;
}

int MeasurementComplexItem::lastSequenceNumber() const {
  return _sequenceNumber + std::max(0, this->_route.size() - 1);
}

578 579
bool MeasurementComplexItem::addGenerator(const QString &name,
                                          routing::GeneratorBase *g) {
580
  if (name.isEmpty()) {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
581 582
    qCDebug(MeasurementComplexItemLog)
        << "registerGenerator(): empty name string.";
583 584 585 586
    return false;
  }

  if (!g) {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
587 588
    qCDebug(MeasurementComplexItemLog)
        << "registerGenerator(): empty generator.";
589 590 591 592
    return false;
  }

  if (this->_generatorNameList.contains(name)) {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
593 594
    qCDebug(MeasurementComplexItemLog) << "registerGenerator(): generator "
                                          "already registered.";
595 596 597 598 599
    return false;
  } else {
    this->_generatorNameList.push_back(name);
    this->_generatorList.push_back(g);
    if (this->_generatorList.size() == 1) {
600
      _setGenerator(g);
601 602 603 604 605 606 607
    }

    emit generatorNameListChanged();
    return true;
  }
}

608
bool MeasurementComplexItem::removeGenerator(const QString &name) {
609 610 611 612 613 614
  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) {
615
        _setGenerator(this->_generatorList.at(index - 1));
616
      } else {
617
        _setGenerator(nullptr);
Valentin Platzgummer's avatar
Valentin Platzgummer committed
618
        qCDebug(MeasurementComplexItemLog)
619 620 621 622 623
            << "unregisterGenerator(): last generator unregistered.";
      }
    }

    this->_generatorNameList.removeAt(index);
624 625
    auto gen = this->_generatorList.takeAt(index);
    gen->deleteLater();
626 627 628 629

    emit generatorNameListChanged();
    return true;
  } else {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
630
    qCDebug(MeasurementComplexItemLog)
631 632 633 634 635
        << "unregisterGenerator(): generator " << name << " not registered.";
    return false;
  }
}

636
bool MeasurementComplexItem::removeGenerator(int index) {
637
  if (index > 0 && index < this->_generatorNameList.size()) {
638
    return removeGenerator(this->_generatorNameList.at(index));
639
  } else {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
640 641 642 643 644
    qCDebug(MeasurementComplexItemLog)
        << "unregisterGenerator(): index (" << index
        << ") out"
           "of bounds ( "
        << this->_generatorList.size() << " ).";
645 646 647 648
    return false;
  }
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
649
bool MeasurementComplexItem::switchToGenerator(const QString &name) {
650 651
  auto index = this->_generatorNameList.indexOf(name);
  if (index >= 0) {
652
    _setGenerator(this->_generatorList.at(index));
653 654
    return true;
  } else {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
655
    qCDebug(MeasurementComplexItemLog)
656 657 658 659 660
        << "switchToGenerator(): generator " << name << " not registered.";
    return false;
  }
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
661
bool MeasurementComplexItem::switchToGenerator(int index) {
662
  if (index >= 0) {
663
    _setGenerator(this->_generatorList.at(index));
664 665
    return true;
  } else {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
666
    qCDebug(MeasurementComplexItemLog)
Valentin Platzgummer's avatar
Valentin Platzgummer committed
667
        << "switchToGenerator(): index (" << index
Valentin Platzgummer's avatar
Valentin Platzgummer committed
668 669 670
        << ") out"
           "of bounds ( "
        << this->_generatorNameList.size() << " ).";
671 672 673 674
    return false;
  }
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
675
QStringList MeasurementComplexItem::generatorNameList() {
676 677 678
  return this->_generatorNameList;
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
679 680 681
routing::GeneratorBase *MeasurementComplexItem::generator() {
  return _pGenerator;
}
682

Valentin Platzgummer's avatar
Valentin Platzgummer committed
683
int MeasurementComplexItem::generatorIndex() {
684 685 686
  return this->_generatorList.indexOf(this->_pGenerator);
}

687 688
void MeasurementComplexItem::startEditing() {
  if (!editing()) {
689 690
    *_pEditorData = *_pAreaData;
    _setAreaData(_pEditorData);
Valentin Platzgummer's avatar
Valentin Platzgummer committed
691
    _setState(STATE::EDITING);
692 693 694
  }
}

695 696 697 698
void MeasurementComplexItem::stopEditing() {
  if (editing()) {
    bool correct = _pEditorData->isCorrect();
    if (correct) {
699
      *_pAreaData = *_pEditorData;
700
    }
701
    _setAreaData(_pAreaData);
Valentin Platzgummer's avatar
Valentin Platzgummer committed
702
    _setState(STATE::IDLE);
703
    if (correct && *_pEditorData != *_pAreaData) {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
704
      _updateRoute();
705 706 707 708
    }
  }
}

709 710 711 712 713 714 715
void MeasurementComplexItem::abortEditing() {
  if (editing()) {
    _setAreaData(_pAreaData);
    _setState(STATE::IDLE);
  }
}

Valentin Platzgummer's avatar
Valentin Platzgummer committed
716
void MeasurementComplexItem::_storeRoutingData(
Valentin Platzgummer's avatar
Valentin Platzgummer committed
717
    MeasurementComplexItem::PtrRoutingData pRoute) {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
718 719
  if (this->_state == STATE::ROUTING) {
    // Store solutions.
720
    auto ori = this->_pAreaData->origin();
Valentin Platzgummer's avatar
Valentin Platzgummer committed
721 722 723 724 725 726 727 728 729 730
    ori.setAltitude(0);
    QVector<Variant> variantVector;
    const auto nSolutions = pRoute->solutionVector.size();

    for (std::size_t j = 0; j < nSolutions; ++j) {
      Variant var;
      const auto &solution = pRoute->solutionVector.at(j);
      if (solution.size() > 0) {
        const auto &route = solution.at(0);
        const auto &path = route.path;
731 732 733 734 735 736 737

        // Convert to geo coordinates.

        for (const auto &vertex : path) {
          QGeoCoordinate c;
          snake::fromENU(ori, vertex, c);
          var.append(QVariant::fromValue(c));
738 739
        }
      } else {
Valentin Platzgummer's avatar
Valentin Platzgummer committed
740
        qCDebug(MeasurementComplexItemLog)
Valentin Platzgummer's avatar
Valentin Platzgummer committed
741
            << "_setTransects(): solution.size() == 0";
742 743
      }

Valentin Platzgummer's avatar
Valentin Platzgummer committed
744 745 746
      if (var.size() > 0) {
        variantVector.push_back(std::move(var));
      }
747 748
    }

Valentin Platzgummer's avatar
Valentin Platzgummer committed
749 750 751 752
    // Assign routes if no error occured.
    if (variantVector.size() > 0) {
      // Swap first route to _route.
      this->_variantVector.swap(variantVector);
753

Valentin Platzgummer's avatar
Valentin Platzgummer committed
754 755 756 757 758 759 760
      // 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();
761

762
      // Set variant to 0.
Valentin Platzgummer's avatar
Valentin Platzgummer committed
763 764 765 766 767
      disconnect(&this->_variant, &Fact::rawValueChanged, this,
                 &MeasurementComplexItem::_changeVariant);
      this->_variant.setCookedValue(QVariant(0));
      connect(&this->_variant, &Fact::rawValueChanged, this,
              &MeasurementComplexItem::_changeVariant);
768

769
      // Select first variant as route.
770
      this->_route.swap(this->_variantVector.first());
Valentin Platzgummer's avatar
Valentin Platzgummer committed
771
      emit routeChanged();
772 773

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

Valentin Platzgummer's avatar
Valentin Platzgummer committed
782 783 784
Fact *MeasurementComplexItem::variant() { return &_variant; }

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

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

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

792
bool MeasurementComplexItem::idle() const { return _idle(this->_state); }
793

Valentin Platzgummer's avatar
Valentin Platzgummer committed
794
bool MeasurementComplexItem::followTerrain() const { return _followTerrain; }