-
Notifications
You must be signed in to change notification settings - Fork 8
/
Copy pathDeviceManager.h
180 lines (158 loc) · 4.77 KB
/
DeviceManager.h
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
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
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
#pragma once
#include <QObject>
#include <QByteArray>
#include <QString>
#include <QList>
#include <QHash>
#include <QUuid>
#include "Link.h"
#include "streamlist.h"
#include "DevQProperty.h"
#include "ProtoBinnary.h"
#include "IDBinnary.h"
#ifdef MOTOR
#include "motor_control.h"
#endif
class DeviceManager : public QObject
{
Q_OBJECT
public:
/*methods*/
DeviceManager();
~DeviceManager();
Q_INVOKABLE float vruVoltage();
Q_INVOKABLE float vruCurrent();
Q_INVOKABLE float vruVelocityH();
Q_INVOKABLE int pilotArmState();
Q_INVOKABLE int pilotModeState();
QList<DevQProperty*> getDevList();
QList<DevQProperty*> getDevList(BoardVersion ver);
#ifdef MOTOR
bool isMotorControlCreated() const;
#endif
public slots:
Q_INVOKABLE bool isCreatedId(int id);
Q_INVOKABLE StreamListModel* streamsList();
void frameInput(QUuid uuid, Link* link, FrameParser frame);
void openFile(QString filePath);
#ifdef SEPARATE_READING
void closeFile(bool onOpen = false);
#else
void closeFile();
#endif
void onLinkOpened(QUuid uuid, Link *link);
void onLinkClosed(QUuid uuid, Link* link);
void onLinkDeleted(QUuid uuid, Link* link);
void binFrameOut(ProtoBinOut protoOut);
void setProtoBinConsoled(bool isConsoled);
void upgradeLastDev(QByteArray data);
void beaconActivationReceive(uint8_t id);
void beaconDirectQueueAsk();
bool isbeaconDirectQueueAsk() { return isUSBLBeaconDirectAsk; }
void setUSBLBeaconDirectAsk(bool is_ask);
#ifdef MOTOR
float getFAngle();
float getSAngle();
void returnToZero(int id);
void runSteps(int id, int speed, int angle);
void openCsvFile(QString path);
void clearTasks();
void calibrationStandIn(float currFAngle, float taskFAngle, float currSAngle, float taskSAngle);
#endif
signals:
void dataSend(QByteArray data);
void chartComplete(int16_t channel, QVector<uint8_t> data, float resolution, float offset);
void rawDataRecieved(RawData rawData);
void distComplete(int dist);
void usblSolutionComplete(IDBinUsblSolution::UsblSolution data);
void dopplerBeamComlete(IDBinDVL::BeamSolution* beams, uint16_t cnt);
void dvlSolutionComplete(IDBinDVL::DVLSolution dvlSolution);
void chartSetupChanged();
void distSetupChanged();
void datasetChanged();
void transChanged();
void soundChanged();
void UARTChanged();
void upgradeProgressChanged(int progressStatus);
void deviceVersionChanged();
void devChanged();
void streamChanged();
void vruChanged();
void writeProxyFrame(FrameParser frame);
void writeMavlinkFrame(FrameParser frame);
void eventComplete(int timestamp, int id, int unixt);
void rangefinderComplete(float distance);
void positionComplete(double lat, double lon, uint32_t date, uint32_t time);
void gnssVelocityComplete(double hSpeed, double course);
void attitudeComplete(float yaw, float pitch, float roll);
void encoderComplete(float e1, float e2, float e3);
void fileStopsOpening();
#ifdef SEPARATE_READING
void fileStartOpening();
void fileBreaked(bool);
void onFileReadEnough();
#endif
void fileOpened();
#ifdef MOTOR
void motorDeviceChanged();
void anglesHasChanged();
void posIsConstant(float currFAngle, float taskFAngle, float currSAngle, float taskSAngle);
#endif
private:
/*methods*/
DevQProperty* getDevice(QUuid uuid, Link* link, uint8_t addr);
void delAllDev();
void deleteDevicesByLink(QUuid uuid);
DevQProperty* createDev(QUuid uuid, Link* link, uint8_t addr);
/*data*/
struct VruData {
VruData() :
voltage(NAN),
current(NAN),
velocityH(NAN),
armState(-1),
flightMode(-1)
{};
void cleanVru()
{
voltage = NAN;
current = NAN;
velocityH = NAN;
armState = -1;
flightMode = -1;
};
float voltage;
float current;
float velocityH;
int armState;
int flightMode;
};
VruData vru_;
DevQProperty* lastDevs_;
DevQProperty* lastDevice_;
Link* mavlinkLink_;
QList<DevQProperty*> devList_;
QHash<QUuid, QHash<int, DevQProperty*>> devTree_;
QHash<QUuid, int> otherProtocolStat_;
StreamList streamList_;
QUuid lastUuid_;
QUuid proxyLinkUuid_;
QUuid mavlinUuid_;
int lastAddress_;
int progress_;
bool isConsoled_;
volatile bool break_;
#ifdef SEPARATE_READING
bool onOpen_{ false };
#endif
bool isUSBLBeaconDirectAsk = false;
QTimer beacon_timer;
#ifdef MOTOR
std::unique_ptr<MotorControl> motorControl_;
float fAngle_ = 0.0f;
float sAngle_ = 0.0f;
#endif
private slots:
void readyReadProxy(Link* link);
void readyReadProxyNav(Link* link);
};