WimaPlaner.h 6.96 KB
Newer Older
1
#pragma once
2

3
#include "QmlObjectListModel.h"
4
#include <QObject>
5
#include <QScopedPointer>
6
#include <QSharedPointer>
7

8 9 10 11
#include "Geometry/WimaCorridor.h"
#include "Geometry/WimaCorridorData.h"
#include "Geometry/WimaJoinedArea.h"
#include "Geometry/WimaJoinedAreaData.h"
12 13 14 15
#include "Geometry/WimaMeasurementArea.h"
#include "Geometry/WimaMeasurementAreaData.h"
#include "Geometry/WimaServiceArea.h"
#include "Geometry/WimaServiceAreaData.h"
16
#include "WimaPlanData.h"
17

18 19
#include "Snake/NemoInterface.h"

20
#include "JsonHelper.h"
21

22 23
class MissionController;
class PlanMasterController;
24

25 26 27 28
namespace wima_planer_detail {
class StateMachine;
}

29 30
class WimaPlaner : public QObject {
  Q_OBJECT
31

32
  enum FileType { WimaFile, PlanFile };
33

34
public:
35
  WimaPlaner(QObject *parent = nullptr);
36
  ~WimaPlaner();
37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52
  template <class T> WimaPlaner(T t, QObject *parent = nullptr) = delete;
  template <class T> WimaPlaner(T t) = delete;

  Q_PROPERTY(PlanMasterController *masterController READ masterController WRITE
                 setMasterController NOTIFY masterControllerChanged)
  Q_PROPERTY(MissionController *missionController READ missionController WRITE
                 setMissionController NOTIFY missionControllerChanged)
  Q_PROPERTY(QmlObjectListModel *visualItems READ visualItems NOTIFY
                 visualItemsChanged)
  Q_PROPERTY(int currentPolygonIndex READ currentPolygonIndex WRITE
                 setCurrentPolygonIndex NOTIFY currentPolygonIndexChanged)
  Q_PROPERTY(QString currentFile READ currentFile NOTIFY currentFileChanged)
  Q_PROPERTY(QStringList loadNameFilters READ loadNameFilters CONSTANT)
  Q_PROPERTY(QStringList saveNameFilters READ saveNameFilters CONSTANT)
  Q_PROPERTY(QString fileExtension READ fileExtension CONSTANT)
  Q_PROPERTY(QGeoCoordinate joinedAreaCenter READ joinedAreaCenter CONSTANT)
53
  Q_PROPERTY(NemoInterface *nemoInterface READ nemoInterface CONSTANT)
54 55
  Q_PROPERTY(bool synchronized READ synchronized NOTIFY synchronizedChanged)
  Q_PROPERTY(bool needsUpdate READ needsUpdate NOTIFY needsUpdateChanged)
56 57
  Q_PROPERTY(bool readyForSynchronization READ readyForSynchronization NOTIFY
                 readyForSynchronizationChanged)
58 59
  Q_PROPERTY(bool progressLocked READ progressLocked WRITE setProgressLocked
                 NOTIFY progressLockedChanged)
60 61

  // Property accessors
62 63
  PlanMasterController *masterController(void);
  MissionController *missionController(void);
64
  QmlObjectListModel *visualItems(void);
65 66
  int currentPolygonIndex(void) const;
  QString currentFile(void) const;
67 68
  QStringList loadNameFilters(void) const;
  QStringList saveNameFilters(void) const;
69
  QString fileExtension(void) const;
70
  QGeoCoordinate joinedAreaCenter(void) const;
71
  NemoInterface *nemoInterface(void);
72 73
  bool synchronized();
  bool needsUpdate();
74
  bool readyForSynchronization();
75
  bool progressLocked();
76 77 78 79 80 81 82

  // Property setters
  void setMasterController(PlanMasterController *masterController);
  void setMissionController(MissionController *missionController);
  /// Sets the integer index pointing to the current polygon. Current polygon is
  /// set interactive.
  void setCurrentPolygonIndex(int index);
83
  void setProgressLocked(bool l);
84 85 86 87 88 89 90 91 92 93 94 95

  Q_INVOKABLE WimaPlaner *thisPointer();
  Q_INVOKABLE bool addMeasurementArea();
  /// Removes an area from _visualItems
  /// @param index Index of the area to be removed
  Q_INVOKABLE void removeArea(int index);
  Q_INVOKABLE bool addServiceArea();
  Q_INVOKABLE bool addCorridor();
  /// Remove all areas from WimaPlaner and all mission items from
  /// MissionController
  Q_INVOKABLE void removeAll();
  /// Recalculates vehicle corridor, flight path, etc.
96
  Q_INVOKABLE void update();
97
  /// Pushes the generated mission data to the wimaController.
98
  Q_INVOKABLE void synchronize();
99 100 101 102 103 104 105 106 107 108 109 110
  Q_INVOKABLE void saveToCurrent();
  Q_INVOKABLE void saveToFile(const QString &filename);
  Q_INVOKABLE bool loadFromCurrent();
  Q_INVOKABLE bool loadFromFile(const QString &filename);
  Q_INVOKABLE void resetAllInteractive(void);
  Q_INVOKABLE void setInteractive(void);

  QJsonDocument saveToJson(FileType fileType);
  // static Members
  static const char *wimaFileExtension;
  static const char *areaItemsName;
  static const char *missionItemsName;
111 112

signals:
113 114 115 116 117 118
  void masterControllerChanged(void);
  void missionControllerChanged(void);
  void visualItemsChanged(void);
  void currentPolygonIndexChanged(int index);
  void currentFileChanged();
  void wimaBridgeChanged();
119 120
  void synchronizedChanged(void);
  void needsUpdateChanged(void);
121
  void readyForSynchronizationChanged(void);
122
  void progressLockedChanged();
123 124

private slots:
125
  void updatePolygonInteractivity(int index);
126 127 128 129 130 131 132
  void _update();
  void CSDestroyedHandler();
  void CSMissionItemReadyHandler();
  void CSCalculatingChangedHandler();
  void mAreaPathChangedHandler();
  void mAreaTilesChangedHandler();
  void mAreaProgressChangedHandler();
Valentin Platzgummer's avatar
Valentin Platzgummer committed
133
  void mAreaProgressAcceptedHandler();
134
  void mAreaReadyChangedHandler();
135 136 137
  void sAreaPathChangedHandler();
  void corridorPathChangedHandler();
  void depotChangedHandler();
138 139 140 141
  void missionControllerVisualItemsChangedHandler();
  void missionControllerWaypointPathChangedHandler();
  void missionControllerNewItemsFromVehicleHandler();
  void missionControllerMissionItemCountChangedHandler();
142
  void nemoInterfaceProgressChangedHandler();
143

Valentin Platzgummer's avatar
Valentin Platzgummer committed
144
#ifndef NDEBUG
145
  void autoLoadMission(void);
Valentin Platzgummer's avatar
Valentin Platzgummer committed
146
#endif
147

148 149
private:
signals:
150
  void joinedAreaValidChanged();
151
  void stateChanged();
152

153
private:
154
  // Member Functions
155
  bool toPlanData(WimaPlanData &planData);
156 157 158
  bool shortestPath(const QGeoCoordinate &start,
                    const QGeoCoordinate &destination,
                    QVector<QGeoCoordinate> &path);
159
  void setSynchronized(bool s);
160 161 162 163 164 165
  void enableAreaMonitoring();
  void disableAreaMonitoring();
  void enableMissionControllerMonitoring();
  void disableMissionControllerMonitoring();
  bool areasMonitored();
  bool missionControllerMonitored();
166 167 168 169 170

  // Member Variables
  PlanMasterController *_masterController;
  MissionController *_missionController;
  int _currentAreaIndex;
171 172
  QString _currentFile;

173
  bool _joinedAreaValid;
174
  WimaMeasurementArea _measurementArea;
175
  bool _copyMAreaToSurvey;
176
  WimaServiceArea _serviceArea;
177
  bool _copySAreaToSurvey;
178
  WimaCorridor _corridor;
179
  bool _corridorChanged;
180 181 182 183 184 185 186 187
  // contains all visible areas
  QmlObjectListModel _visualItems;
  // joined area fromed by _measurementArea, _serviceArea, _corridor
  WimaJoinedArea _joinedArea;
  // path from takeoff to first measurement point
  unsigned long _arrivalPathLength;
  // path from last measurement point to land
  unsigned long _returnPathLength;
188

189
  CircularSurvey *_survey;
190
  bool _surveyChanged;
191
  // sync stuff
192 193
  bool _synchronized; // true if planData is synchronized with
                      // wimaController
194

Valentin Platzgummer's avatar
Valentin Platzgummer committed
195
#ifndef NDEBUG
196 197
  QTimer _autoLoadTimer; // timer to auto load mission after some time, prevents
                         // seg. faults
Valentin Platzgummer's avatar
Valentin Platzgummer committed
198
#endif
199 200

  NemoInterface _nemoInterface;
201 202 203

  // State
  QScopedPointer<wima_planer_detail::StateMachine> _stateMachine;
204 205
  bool _areasMonitored;
  bool _missionControllerMonitored;
206
  bool _progressLocked;
207
};