WimaPlaner.h 6.92 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

  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.
95
  Q_INVOKABLE void update();
96
  /// Pushes the generated mission data to the wimaController.
97
  Q_INVOKABLE void synchronize();
98 99 100 101 102 103 104 105 106 107 108 109
  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;
110 111

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

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

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

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

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

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

172
  bool _joinedAreaValid;
173
  WimaMeasurementArea _measurementArea;
174
  bool _copyMAreaToSurvey;
175
  WimaServiceArea _serviceArea;
176
  bool _copySAreaToSurvey;
177
  WimaCorridor _corridor;
178
  bool _corridorChanged;
179 180 181 182 183 184 185 186
  // 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;
187

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

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

  NemoInterface _nemoInterface;
200 201 202

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