@@ -143,82 +143,76 @@ private static void processData(String data)
143
143
{
144
144
try
145
145
{
146
- string [ ] stringSeparators = new string [ ] { "\r \n " , "\r " , "\n " , "\n \r " } ;
146
+ if ( ! data . StartsWith ( "D" ) ) return ;
147
+ string [ ] stringSeparators = new string [ ] { "\r \n " , "\r " , "\n " , "\n \r " , "." } ;
147
148
string [ ] lines = data . Split ( stringSeparators , StringSplitOptions . None ) ;
148
- for ( int linen = 0 ; linen < lines . Length ; linen ++ )
149
+ for ( int i = 0 ; i < lines . Length ; i ++ )
149
150
{
150
- String line = lines [ linen ] ;
151
- bool isDataPacket = false ;
151
+ String line = lines [ i ] ;
152
152
if ( line != "" )
153
153
{
154
- if ( line [ 0 ] == 'D' )
154
+ String dataline = line . Substring ( 1 ) ;
155
+ string [ ] parts = dataline . Split ( '.' ) ;
156
+ byte [ ] buf = HexToBytes ( parts [ 1 ] . Replace ( "-" , "" ) ) ;
157
+ if ( buf . Length == 0 )
155
158
{
156
- String dataline = line . Substring ( 1 ) ;
157
- string [ ] parts = dataline . Split ( '.' ) ;
158
- byte [ ] buf = HexToBytes ( parts [ 1 ] . Replace ( "-" , "" ) ) ;
159
- if ( buf . Length > 0 )
159
+ continue ;
160
+ }
161
+
162
+ int packet_type = buf [ 0 ] ;
163
+ if ( ( packet_type >= 1 ) && ( packet_type <= 11 ) )
164
+ {
165
+ if ( buf . Length == 40 )
160
166
{
161
- int packet_type = buf [ 0 ] ;
162
- if ( ( packet_type >= 1 ) && ( packet_type <= 11 ) )
167
+ int eegrv = buf [ 1 ] * 256 + buf [ 2 ] ;
168
+ int eeglv = buf [ 3 ] * 256 + buf [ 4 ] ;
169
+ int dx = buf [ 5 ] * 256 + buf [ 6 ] ;
170
+ int dy = buf [ 7 ] * 256 + buf [ 8 ] ;
171
+ int dz = buf [ 9 ] * 256 + buf [ 10 ] ;
172
+ double scaled_eegr = ScaleEEG ( eegrv ) ;
173
+ double scaled_eegl = ScaleEEG ( eeglv ) ;
174
+ double scaled_dx = ScaleAccel ( dx ) ;
175
+ double scaled_dy = ScaleAccel ( dy ) ;
176
+ double scaled_dz = ScaleAccel ( dz ) ;
177
+
178
+ scaled_eegr += 500 ;
179
+ scaled_eegl += 500 ;
180
+
181
+ m_dblX = ( scaled_dx + 2 ) * 250 ;
182
+ m_dblY = ( scaled_dy + 2 ) * 250 ;
183
+ m_dblZ = ( scaled_dz + 2 ) * 250 ;
184
+
185
+ if ( ClearDisplay )
163
186
{
164
- if ( buf . Length == 40 )
165
- {
166
- isDataPacket = true ;
167
- int eegrv = buf [ 1 ] * 256 + buf [ 2 ] ;
168
- int eeglv = buf [ 3 ] * 256 + buf [ 4 ] ;
169
- int dx = buf [ 5 ] * 256 + buf [ 6 ] ;
170
- int dy = buf [ 7 ] * 256 + buf [ 8 ] ;
171
- int dz = buf [ 9 ] * 256 + buf [ 10 ] ;
172
- double scaled_eegr = ScaleEEG ( eegrv ) ;
173
- double scaled_eegl = ScaleEEG ( eeglv ) ;
174
- double scaled_dx = ScaleAccel ( dx ) ;
175
- double scaled_dy = ScaleAccel ( dy ) ;
176
- double scaled_dz = ScaleAccel ( dz ) ;
177
-
178
- scaled_eegr += 500 ;
179
- scaled_eegl += 500 ;
180
-
181
- m_dblX = ( scaled_dx + 2 ) * 250 ;
182
- m_dblY = ( scaled_dy + 2 ) * 250 ;
183
- m_dblZ = ( scaled_dz + 2 ) * 250 ;
184
-
185
- if ( ClearDisplay )
186
- {
187
- ClearDisplay = false ;
188
- DisplayValue = 0 ;
189
- }
190
-
191
- if ( ClearHighscore )
192
- {
193
- ClearHighscore = false ;
194
- DisplayValue = 0 ;
195
- }
196
-
197
- double raw = ( scaled_eegr + scaled_eegl ) / 2 ;
198
- if ( raw >= HighscoreValue )
199
- {
200
- HighscoreValue = ( scaled_eegr + scaled_eegl ) / 2 ;
201
- }
202
-
203
- DisplayValue = ( scaled_eegr + scaled_eegl ) / 2 ;
204
-
205
- if ( ZMaxEEGRChanged != null )
206
- {
207
- ZMaxEEGRChanged ( null , new ZMaxChangedEventArgs ( Convert . ToInt32 ( scaled_eegr ) ) ) ;
208
- }
209
- if ( ZMaxEEGLChanged != null )
210
- {
211
- ZMaxEEGLChanged ( null , new ZMaxChangedEventArgs ( Convert . ToInt32 ( scaled_eegl ) ) ) ;
212
- }
213
- }
187
+ ClearDisplay = false ;
188
+ DisplayValue = 0 ;
189
+ }
190
+
191
+ if ( ClearHighscore )
192
+ {
193
+ ClearHighscore = false ;
194
+ DisplayValue = 0 ;
195
+ }
196
+
197
+ double raw = ( scaled_eegr + scaled_eegl ) / 2 ;
198
+ if ( raw >= HighscoreValue )
199
+ {
200
+ HighscoreValue = ( scaled_eegr + scaled_eegl ) / 2 ;
201
+ }
202
+
203
+ DisplayValue = ( scaled_eegr + scaled_eegl ) / 2 ;
204
+
205
+ if ( ZMaxEEGRChanged != null )
206
+ {
207
+ ZMaxEEGRChanged ( null , new ZMaxChangedEventArgs ( Convert . ToInt32 ( scaled_eegr ) ) ) ;
208
+ }
209
+ if ( ZMaxEEGLChanged != null )
210
+ {
211
+ ZMaxEEGLChanged ( null , new ZMaxChangedEventArgs ( Convert . ToInt32 ( scaled_eegl ) ) ) ;
214
212
}
215
213
}
216
214
}
217
215
}
218
- if ( ! isDataPacket )
219
- {
220
-
221
- }
222
216
}
223
217
}
224
218
catch ( Exception ex )
0 commit comments