WimaPlaner.h 7.01 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 24
class MissionController;
class PlanMasterController;
class WimaBridge;
25

26 27 28 29
namespace wima_planer_detail {
class StateMachine;
}

30 31
class WimaPlaner : public QObject {
  Q_OBJECT
32

33
  enum FileType { WimaFile, PlanFile };
34

35
public:
36
  WimaPlaner(QObject *parent = nullptr);
37
  ~WimaPlaner();
38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55
  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)
  Q_PROPERTY(WimaBridge *wimaBridge READ wimaBridge WRITE setWimaBridge NOTIFY
                 wimaBridgeChanged)
56
  Q_PROPERTY(NemoInterface *nemoInterface READ nemoInterface CONSTANT)
57 58
  Q_PROPERTY(bool synchronized READ synchronized NOTIFY synchronizedChanged)
  Q_PROPERTY(bool needsUpdate READ needsUpdate NOTIFY needsUpdateChanged)
59 60
  Q_PROPERTY(bool readyForSynchronization READ readyForSynchronization NOTIFY
                 readyForSynchronizationChanged)
61 62

  // Property accessors
63 64
  PlanMasterController *masterController(void);
  MissionController *missionController(void);
65
  QmlObjectListModel *visualItems(void);
66 67
  int currentPolygonIndex(void) const;
  QString currentFile(void) const;
68 69
  QStringList loadNameFilters(void) const;
  QStringList saveNameFilters(void) const;
70
  QString fileExtension(void) const;
71
  QGeoCoordinate joinedAreaCenter(void) const;
72
  WimaBridge *wimaBridge(void);
73
  NemoInterface *nemoInterface(void);
74 75
  bool synchronized();
  bool needsUpdate();
76
  bool readyForSynchronization();
77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96

  // 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);
  void setWimaBridge(WimaBridge *bridge);

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

signals:
114 115 116 117 118 119
  void masterControllerChanged(void);
  void missionControllerChanged(void);
  void visualItemsChanged(void);
  void currentPolygonIndexChanged(int index);
  void currentFileChanged();
  void wimaBridgeChanged();
120 121
  void synchronizedChanged(void);
  void needsUpdateChanged(void);
122
  void readyForSynchronizationChanged(void);
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
  QSharedPointer<WimaPlanData> toPlanData();
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 173 174
  QString _currentFile;
  // container for data exchange with WimaController
  WimaBridge *_wimaBridge;

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

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

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

  NemoInterface _nemoInterface;
203 204 205

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