-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathECG250HzCapture.cpp
57 lines (49 loc) · 1.05 KB
/
ECG250HzCapture.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
//
//
//
#include "ECG250HzCapture.h"
LinkedList<float> ECG250HzCapture::read(int size)
{
LinkedList<float> list;
uint8_t dataBuffer[4] = { 0,0,0,0 };
int makeIt250Hz = 0;
for (int i = 0; i < size * 4; i++)
{
bool drdy = true;
while (drdy)
{
adas1000->readFrame(dataBuffer);
drdy = dataBuffer[0] & 0x40;
}
if (dataBuffer[0] < 0x80)
{
if (makeIt250Hz %2) {
uint32_t data = (dataBuffer[1] << 16) + (dataBuffer[2] << 8) + dataBuffer[3];
list.add(adas1000->voltageConversion(data, format));
}
makeIt250Hz++;
}
}
return list;
}
float ECG250HzCapture::read()
{
uint8_t dataBuffer[4] = { 0, 0, 0, 0 };
for (int i = 0; i < 2; i++){
do{
bool drdy = true;
while (drdy)
{
adas1000->readFrame(dataBuffer);
drdy = dataBuffer[0] & 0x40;
}
} while (dataBuffer[0] & 0x80);
}
uint32_t data = (dataBuffer[1] << 16) + (dataBuffer[2] << 8) + dataBuffer[3];
return adas1000->voltageConversion(data, format);
}
void ECG250HzCapture::initialize(void)
{
ECGCapture::initialize();
adas1000->setFRMCTL_Skip4thFrame();
}