Repository navigation
Expand file tree
/
Copy pathDeviceDataCollector.cpp
More file actions
139 lines (116 loc) · 3.87 KB
/
Copy pathDeviceDataCollector.cpp
File metadata and controls
139 lines (116 loc) · 3.87 KB
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
#include "stdafx.h"
#include <sensor/shimmer/DeviceDataCollector.h>
#include <iostream>
#include <sstream>
#include <ctime>
#include <chrono>
#pragma unmanaged
#include "lsl_cpp.h"
#pragma managed
#define Channel_Count 2
//#define SamplingRate 10.2
#define SamplingRate 256
#define PacketLSL 64
DeviceDataCollector::DeviceDataCollector(void)
:_mychunk( Channel_Count, std::vector<float>( PacketLSL ) )
{
_lastError = 0;
_handle = NULL;
_outlet = NULL;
_index = 0;
}
DeviceDataCollector::~DeviceDataCollector(void)
{
if( NULL != _outlet )
{
delete _outlet;
_outlet = NULL;
}
if( NULL != _handle )
{
_handle = NULL;
}
}
unsigned int DeviceDataCollector::Open( std::wstring comPort )
{
//_comPort = comPort;
//std::cout << comPort << std::endl;
//std::wstring stemp = std::wstring(comPort.begin(), comPort.end());
unsigned int error;
try {
error = Shimmer_Open(comPort.c_str(), &_handle);
}
catch(...){
error = 0xC00B0000;
}
//unsigned int error = Shimmer_Open(L"COM3", &_handle);
if( error == IO_NO_ERROR )
{
Shimmer_SetAcquisitionCallBack( _handle, ( DTACALLBACK ) DeviceDataCollector::ProcData, this );
lsl::stream_info info("Shimmer","BIO", Channel_Count,SamplingRate,lsl::cf_float32,"Shimmer_" + _comPort);
lsl::xml_element time = info.desc().append_child("event_synchronization");
//unix timestamp in seconds;
std::ostringstream unixtimestamp;
unixtimestamp.precision(15);
unixtimestamp << std::time(0);
//unix timestamp in milliseconds
std::chrono::milliseconds ms = std::chrono::duration_cast< std::chrono::milliseconds >(
std::chrono::system_clock::now().time_since_epoch()
);
std::ostringstream unixtimestampms;
unixtimestampms.precision(15);
unixtimestampms << ms.count();
//lsl local clock
std::ostringstream lslclock;
lslclock.precision(15);
lslclock << lsl::lsl_local_clock();
//offset in milliseconds
std::ostringstream timeoffset;
timeoffset.precision(15);
timeoffset << (ms.count() - lsl::lsl_local_clock());
time.append_child_value("unixtimestamp", unixtimestamp.str());
time.append_child_value("unixtimestmapms", unixtimestampms.str());
time.append_child_value("lslclock", lslclock.str());
time.append_child_value("streamoffset", timeoffset.str());
// add some description fields
info.desc().append_child_value("manufacturer", "Shimmer");
info.desc().append_child("channel")
.append_child_value("name","Heart Rate")
.append_child_value("unit","bpm")
.append_child_value("type","BIO SIGNAL");
info.desc().append_child("channel")
.append_child_value("name","GSR")
.append_child_value("unit","kOhm")
.append_child_value("type","BIO SIGNAL");
// make a new outlet
_outlet = new lsl::stream_outlet (info);
}
return error;
}
unsigned int DeviceDataCollector::Close( )
{
return Shimmer_Close( _handle );
}
unsigned int DeviceDataCollector::SetAcquisitionMode( unsigned int mode )
{
return Shimmer_SetAcquisitionMode( _handle, mode );
}
void __cdecl DeviceDataCollector::ProcData( void *context, const double acquisitionTime, const float heartRate, const float gsr_value )
{
//std::cout << "procdata" << std::endl;
((DeviceDataCollector*)context)->_mychunk[ 0 ][ ((DeviceDataCollector*)context)->_index] = (float)heartRate;
((DeviceDataCollector*)context)->_mychunk[ 1 ][ ((DeviceDataCollector*)context)->_index] = (float)gsr_value;
((DeviceDataCollector*)context)->_index++;
if( ((DeviceDataCollector*)context)->_index == PacketLSL)
{
std::vector<std::vector<float>> chunk( PacketLSL );
for( int i = 0; i < PacketLSL; i++ )
{
// std::cout << ((DeviceDataCollector*)context)->_mychunk[0][i] << std::endl;
chunk[ i ].push_back(((DeviceDataCollector*)context)->_mychunk[ 0 ][ i ] );
chunk[ i ].push_back(((DeviceDataCollector*)context)->_mychunk[ 1 ][ i ] );
}
((DeviceDataCollector*)context)->_outlet->push_chunk(chunk);
((DeviceDataCollector*)context)->_index = 0;
}
}