@@ -227,59 +227,38 @@ Module.prototype.requestLocalData = function() {
227
227
228
228
Module . prototype . handleLocalData = function ( data ) {
229
229
// Robot data -> EntryHW, save to sensory data
230
+ var str = '' ;
231
+ var j = 100 ;
232
+ var sensory = this . sensory ;
230
233
231
- var str = '' ;
232
234
if ( data . length ) {
233
235
for ( var i = 0 ; i < data . length ; i ++ ) {
234
236
str = str + this . buf2hex ( data [ i ] ) ;
237
+ if ( this . buf2hex ( data [ i ] ) == '5F' && this . buf2hex ( data [ i + 1 ] ) == '7E' && this . buf2hex ( data [ i + 18 ] ) == '0D' && this . buf2hex ( data [ i + 19 ] ) == '0A' ) {
238
+ j = i ;
239
+ sensory . L2 = data [ j + 2 ] ;
240
+ sensory . L1 = data [ j + 3 ] ;
241
+ sensory . R1 = data [ j + 4 ] ;
242
+ sensory . R2 = data [ j + 5 ] ;
243
+ sensory . ProxiLeft = data [ j + 6 ] ;
244
+ sensory . ProxiRight = data [ j + 7 ] ;
245
+
246
+ sensory . AccX = data [ j + 8 ] ;
247
+ sensory . AccY = data [ j + 9 ] ;
248
+ sensory . AccZ = data [ j + 10 ] ;
249
+ sensory . AccStatus = data [ j + 11 ] ;
250
+
251
+ sensory . BColorKey = data [ j + 14 ] ;
252
+ sensory . BColorRed = data [ j + 15 ] ;
253
+ sensory . BColorGreen = data [ j + 16 ] ;
254
+ sensory . BColorBlue = data [ j + 17 ] ;
255
+ sensory . FColorLeftKey = data [ j + 12 ] ;
256
+ sensory . FColorRightKey = data [ j + 13 ] ;
257
+
258
+ }
235
259
}
236
- //console.log("D:"+str);
237
- //console.log("L:"+data.length);
238
260
}
239
- /*
240
- if(data.length != 19) return;
241
-
242
- if(data[0] != 0x7E) return; // invalid data
243
- var sensory = this.sensory;
244
-
245
- sensory.L2 = data[1];
246
- sensory.L1 = data[2];
247
- sensory.R1 = data[3];
248
- sensory.R2 = data[4];
249
- sensory.ProxiLeft = data[5];
250
- sensory.ProxiRight = data[6];
251
- sensory.AccX = data[7];
252
- sensory.AccY = data[8];
253
- sensory.AccZ = data[9];
254
- sensory.AccStatus = data[10];
255
- sensory.BColorKey = data[13];
256
- sensory.BColorRed = data[14];
257
- sensory.BColorGreen = data[15];
258
- sensory.BColorBlue = data[16];
259
- sensory.FColorLeftKey = data[11];
260
- sensory.FColorRightKey = data[12];
261
- */
262
- if ( data . length != 20 ) return ;
263
-
264
- if ( data [ 0 ] != 0x5f ) return ; // invalid data
265
- var sensory = this . sensory ;
266
-
267
- sensory . L2 = data [ 2 ] ;
268
- sensory . L1 = data [ 3 ] ;
269
- sensory . R1 = data [ 4 ] ;
270
- sensory . R2 = data [ 5 ] ;
271
- sensory . ProxiLeft = data [ 6 ] ;
272
- sensory . ProxiRight = data [ 7 ] ;
273
- sensory . AccX = data [ 8 ] ;
274
- sensory . AccY = data [ 9 ] ;
275
- sensory . AccZ = data [ 10 ] ;
276
- sensory . AccStatus = data [ 11 ] ;
277
- sensory . BColorKey = data [ 14 ] ;
278
- sensory . BColorRed = data [ 15 ] ;
279
- sensory . BColorGreen = data [ 16 ] ;
280
- sensory . BColorBlue = data [ 17 ] ;
281
- sensory . FColorLeftKey = data [ 12 ] ;
282
- sensory . FColorRightKey = data [ 13 ] ;
261
+
283
262
} ;
284
263
285
264
//0xff 0x55 0x6 0x0 0x1 0xa 0x9 0x0 0x0 0xa
0 commit comments