forked from AmurSU/TSProject
-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathtsusbdatareader.cpp
277 lines (247 loc) · 9.53 KB
/
tsusbdatareader.cpp
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
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
#include "tsusbdatareader.h"
TSUsbDataReader::TSUsbDataReader(QObject *parent) :
QObject(parent)
{
}
bool TSUsbDataReader::initDevice(TSCurveBuffer *_bf){
buffer=_bf;
typedef DWORD(*GetDllVersion)();
typedef LPVOID(*CreateInstance)(PCHAR const);
QLibrary myLib("dll/Rtusbapi.dll");
myLib.load();
GetDllVersion RtGetDllVersion = (GetDllVersion) myLib.resolve("RtGetDllVersion");
if (RtGetDllVersion) {
if (RtGetDllVersion() == CURRENT_VERSION_RTUSBAPI){
qDebug() << "Dll version is correct";
}
else{
qDebug() << "Dll version isn`t correct";
this->setLastError("Dll version isn`t correct");
return false;
}
}
CreateInstance RtCreateInstance = (CreateInstance) myLib.resolve("RtCreateInstance");
if (RtCreateInstance) {
pModule = static_cast<IRTUSB3000 *> (RtCreateInstance("usb3000"));
if(pModule == NULL){
qDebug() << "Can`t create usb3000 instance";
return false;
}else{
qDebug() << "Create usb3000 instance";
}
}
WORD i;
// ïðîâåðèì âåðñèþ èñïîëüçóåìîé áèáëèîòåêè Rtusbapi.dll
if ((DllVersion = RtGetDllVersion()) != CURRENT_VERSION_RTUSBAPI) {
char String[128];
sprintf(String, " Rtusbapi.dll Version Error!!!\n Current: %1u.%1u. Required: %1u.%1u",
DllVersion >> 0x10, DllVersion & 0xFFFF,
CURRENT_VERSION_RTUSBAPI >> 0x10, CURRENT_VERSION_RTUSBAPI & 0xFFFF);
TerminateApplication(String);
} else printf(" Rtusbapi.dll Version --> OK\n");
// ïîëó÷èì óêàçàòåëü íà èíòåðôåéñ ìîäóëÿ USB3000
pModule = static_cast<IRTUSB3000 *> (RtCreateInstance("usb3000"));
if (!pModule) TerminateApplication(" Module Interface --> Bad\n");
else printf(" Module Interface --> OK\n");
// ïîïðîáóåì îáíàðóæèòü ìîäóëü USB3000 â ïåðâûõ 127 âèðòóàëüíûõ ñëîòàõ
for (i = 0x0; i < MaxVirtualSoltsQuantity; i++) if (pModule->OpenDevice(i)) break;
// ÷òî-íèáóäü îáíàðóæèëè?
if (i == MaxVirtualSoltsQuantity) TerminateApplication(" Can't find module USB3000 in first 127 virtual slots!\n");
else printf(" OpenDevice(%u) --> OK\n", i);
// ïðî÷èòàåì íàçâàíèå îáíàðóæåííîãî ìîäóëÿ
if (!pModule->GetModuleName(ModuleName)) TerminateApplication(" GetModuleName() --> Bad\n");
else printf(" GetModuleName() --> OK\n");
// ïðîâåðèì, ÷òî ýòî 'USB3000'
if (strcmp(ModuleName, "USB3000")) TerminateApplication(" The module is not 'USB3000'\n");
else printf(" The module is 'USB3000'\n");
// óçíàåì òåêóùóþ ñêîðîñòü ðàáîòû øèíû USB20
if (!pModule->GetUsbSpeed(&UsbSpeed)) {
printf(" GetUsbSpeed() --> Bad\n");
exit(1);
} else printf(" GetUsbSpeed() --> OK\n");
// òåïåðü îòîáðàçèì âåðñèþ äðàéâåðà AVR
printf(" USB Speed is %s\n", UsbSpeed ? "HIGH (480 Mbit/s)" : "FULL (12 Mbit/s)");
// ïðî÷èòàåì ñåðèéíûé íîìåð ìîäóëÿ
if (!pModule->GetModuleSerialNumber(ModuleSerialNumber)) TerminateApplication(" GetModuleSerialNumber() --> Bad\n");
else printf(" GetModuleSerialNumber() --> OK\n");
// òåïåðü îòîáðàçèì ñåðèéíûé íîìåð ìîäóëÿ
printf(" Module Serial Number is %s\n", ModuleSerialNumber);
// ïðî÷èòàåì âåðñèþ äðàéâåðà AVR
if (!pModule->GetAvrVersion(AvrVersion)) TerminateApplication(" GetAvrVersion() --> Bad\n");
else printf(" GetAvrVersion() --> OK\n");
// òåïåðü îòîáðàçèì âåðñèþ äðàéâåðà AVR
printf(" Avr Driver Version is %s\n", AvrVersion);
// êîä äðàéâåðà DSP âîçüì¸ì èç ñîîòâåòñòâóþùåãî ðåñóðñà øòàòíîé DLL áèáëèîòåêè
if (!pModule->LOAD_DSP()) TerminateApplication(" LOAD_DSP() --> Bad\n");
else printf(" LOAD_DSP() --> OK\n");
// ïðîâåðèì çàãðóçêó ìîäóëÿ
if (!pModule->MODULE_TEST()) TerminateApplication(" MODULE_TEST() --> Bad\n");
else printf(" MODULE_TEST() --> OK\n");
// ïîëó÷èì âåðñèþ çàãðóæåííîãî äðàéâåðà DSP
if (!pModule->GET_DSP_INFO(&di)) TerminateApplication(" GET_DSP_INFO() --> Bad\n");
else printf(" GET_DSP_INFO() --> OK\n");
// òåïåðü îòîáðàçèì âåðñèþ çàãðóæåííîãî äðàéâåðà DSP
printf(" DSP Driver version is %1u.%1u\n", di.DspMajor, di.DspMinor);
// îáÿçàòåëüíî ïðîèíèöèàëèçèðóåì ïîëå size ñòðóêòóðû RTUSB3000::FLASH
fi.size = sizeof (RTUSB3000::FLASH);
// ïîëó÷èì èíôîðìàöèþ èç ÏÏÇÓ ìîäóëÿ
if (!pModule->GET_FLASH(&fi)) TerminateApplication(" GET_FLASH() --> Bad\n");
else printf(" GET_FLASH() --> OK\n");
// îáÿçàòåëüíî ïðîèíèöèàëèçèðóåì ïîëå size ñòðóêòóðû RTUSB3000::INPUT_PARS
ip.size = sizeof (RTUSB3000::INPUT_PARS);
// ïîëó÷èì òåêóùèå ïàðàìåòðû ðàáîòû ÀÖÏ
if (!pModule->GET_INPUT_PARS(&ip)) TerminateApplication(" GET_INPUT_PARS() --> Bad\n");
else printf(" GET_INPUT_PARS() --> OK\n");
// óñòàíîâèì æåëàåìûå ïàðàìåòðû ââîäà äàííûõ
ip.CorrectionEnabled = true; // ðàçðåøèì êîððåêòèðîâêó äàííûõ
ip.InputClockSource = RTUSB3000::INTERNAL_INPUT_CLOCK; // áóäåì èñïîëüçîâàòü âíóòðåííèå òàêòîâûå èñïóëüñû äëÿ ââîäà äàííûõ
// ip.InputClockSource = RTUSB3000::EXTERNAL_INPUT_CLOCK; // áóäåì èñïîëüçîâàòü âíåøíèå òàêòîâûå èñïóëüñû äëÿ ââîäà äàííûõ
ip.SynchroType = RTUSB3000::NO_SYNCHRO; // íå áóäåì èñïîëüçîâàòü íèêàêóþ ñèíõðîíèçàöèþ ïðè ââîäå äàííûõ
// ip.SynchroType = RTUSB3000::TTL_START_SYNCHRO; // áóäåì èñïîëüçîâàòü öèôðîâóþ ñèíõðîíèçàöèþ ñòàðòà ïðè ââîäå äàííûõ
ip.ChannelsQuantity = CHANNELS_QUANTITY; // ÷åòûðå àêòèâíûõ êàíàëà
for (i = 0x0; i < CHANNELS_QUANTITY; i++) ip.ControlTable[i] = (WORD) (i);
ip.InputRate = ReadRate; // ÷àñòîòà ðàáîòû ÀÖÏ â êÃö
ip.InterKadrDelay = 0.0;
// áóäåì èñïîëüçîâàòü ôèðìåííûå êàëèáðîâî÷íûå êîýôôèöèåíòû, êîòîðûå õðàíÿòüñÿ â ÏÏÇÓ ìîäóëÿ
for (i = 0x0; i < 8; i++) {
ip.AdcOffsetCoef[i] = fi.AdcOffsetCoef[i];
ip.AdcScaleCoef[i] = fi.AdcScaleCoef[i];
}
// ïåðåäàäèì òðåáóåìûå ïàðàìåòðû ðàáîòû ââîäà äàííûõ â äðàéâåð DSP ìîäóëÿ
if (!pModule->SET_INPUT_PARS(&ip)) TerminateApplication(" SET_INPUT_PARS() --> Bad\n");
else printf(" SET_INPUT_PARS() --> OK\n");
// îòîáðàçèì ïàðàìåòðû ìîäóëÿ íà ýêðàíå ìîíèòîðà
printf(" \n");
printf(" Module USB3000 (S/N %s) is ready ... \n", fi.SerialNumber);
printf(" Adc parameters:\n");
printf(" InputClockSource is %s\n", ip.InputClockSource ? "EXTERNAL" : "INTERNAL");
printf(" SynchroType is %s\n", ip.SynchroType ? "TTL_START_SYNCHRO" : "NO_SYNCHRO");
printf(" ChannelsQuantity = %2d\n", ip.ChannelsQuantity);
printf(" AdcRate = %8.3f kHz\n", ip.InputRate);
//printf(" InterKadrDelay = %2.4f ms\n", ip.InterKadrDelay);
printf(" ChannelRate = %8.3f kHz\n", ip.ChannelRate);
printf("\n Press any key to terminate this program...\n");
// öèêë ïåðìàíåíòíîãî âûïîëíåíèÿ ôóíêöèè ADC_KADR è
// îòîáðàæåíèÿ ïîëó÷åííûõ äàííûõ íà ýêðàíå äèïëåÿ
//emit ñèãíàë î òîì ÷òî ïîòîê ñîçäàí
}
bool TSUsbDataReader::closeReader()
{
qDebug()<<"close Reader";
if (pModule->CloseDevice()) {
return true;
}
else
{
this->setLastError("Can`t close device");
return false;
}
}
void TSUsbDataReader::read()
{
switch (readingType)
{
case ReadAll:
{
qDebug()<<"read all "<<this->ReadingStarted;
while(this->ReadingStarted)
{
SHORT* adc;
if ((adc=readData())!=0){
buffer->append(adc[0],adc[1],adc[2]);
startTimer(10);
}
else{
qDebug()<<"Get crashe";
startTimer(10);
}
delete adc;
}
break;
}
case ReadForVolZer:
{
int avg=0;
qDebug()<<"Rading zero leav start";
for(int i=0;i<300;i++)
{
SHORT* adc;
if ((adc=readData())!=0){
avg+=adc[0];
if(i%10)
emit changeProgress(i/3);
startTimer(10);
}
else{
qDebug()<<"Get crashe";
startTimer(10);
}
delete adc;
}
avg/=300;
buffer->setVolumeColibration(avg,true);
break;
}
case ReadForVolVal:
{
buffer->setEnd(0);
for(int i=0;i<1200;i++)
{
SHORT* adc;
if ((adc=readData())!=0){
buffer->append(adc[0],0,0);
if(i%24)
emit changeProgress(i/12);
startTimer(10);
}
else{
qDebug()<<"Get crashe";
startTimer(10);
}
delete adc;
}
break;
}
}
closeReader();
emit done();
qDebug()<<"Emit done";
}
void TSUsbDataReader::stopRead()
{
ReadingStarted=false;
closeReader();
}
void TSUsbDataReader::setReadingType(TSUsbReadingType type){
readingType = type;
}
void TSUsbDataReader::TerminateApplication(char *ErrorString, bool TerminationFlag){
// ïîä÷èùàåì èíòåðôåéñ ìîäóëÿ
if (pModule) {
// îñâîáîäèì èíòåðôåéñ ìîäóëÿ
if (!pModule->ReleaseInstance()) printf(" ReleaseInstance() --> Bad\n");
else printf(" ReleaseInstance() --> OK\n");
// îáíóëèì óêàçàòåëü íà èíòåðôåéñ ìîäóëÿ
pModule = NULL;
}
// âûâîäèì òåêñò ñîîáùåíèÿ
if (ErrorString) printf(ErrorString);
// åñëè íóæíî - àâàðèéíî çàâåðøàåì ïðîãðàììó
if (TerminationFlag) exit(1);
else return;
}
void TSUsbDataReader::setLastError(QString)
{
;
}
SHORT *TSUsbDataReader::readData()
{
if (pModule->READ_KADR(AdcBuffer)) {
return AdcBuffer;
}
else
{
this->setLastError("Can`t read from device");
return NULL;
}
}