diff options
Diffstat (limited to 'src/survive_process.c')
| -rw-r--r-- | src/survive_process.c | 32 |
1 files changed, 29 insertions, 3 deletions
diff --git a/src/survive_process.c b/src/survive_process.c index a4680af..139ae2f 100644 --- a/src/survive_process.c +++ b/src/survive_process.c @@ -3,16 +3,42 @@ #include "survive_internal.h" + +int bufferpts[32*2]; +char buffermts[32*128]; +int buffertimeto[32]; + void survive_light_process( struct SurviveObject * so, int sensor_id, int acode, int timeinsweep, uint32_t timecode ) { + if( acode == -1 ) return; + + if( acode == 0 || acode == 2 ) //data = 0 + { + printf( "L, X, %s, %d, %d, %d, %d\n", so->codename, timecode, sensor_id, acode, timeinsweep ); + bufferpts[sensor_id*2+0] = (timeinsweep-170000)/100; + buffertimeto[sensor_id] = 0; + //printf( "X: %d\n",bufferpts[sensor_id*2+0] ); + //480-(timeinsweep)/1000; // Full scan + } + if( acode == 1 || acode == 3 ) //data = 1 + { + printf( "L, Y, %s, %d, %d, %d, %d\n", so->codename, timecode, sensor_id, acode, timeinsweep ); + bufferpts[sensor_id*2+1] = 480-(timeinsweep-140000)/100; + //printf( "Y: %d\n",bufferpts[sensor_id*2+1] ); + buffertimeto[sensor_id] = 0; + + //480-(timeinsweep)/1000; //Full scan + } + + //timeinsweep = 200,000 1/48,000,000ths of a second is "center-of-image" - //printf( "L %s %d %d %d %d\n", so->codename, timecode, sensor_id, acode, timeinsweep ); } void survive_imu_process( struct SurviveObject * so, int16_t * accelgyro, uint32_t timecode, int id ) { - if( so->codename[0] != 'H' ) + //if( so->codename[0] == 'H' ) + if( 0 ) { - //printf( "I %s %d %d %d %d %d %d %d %d\n", so->codename, timecode, accelgyro[0], accelgyro[1], accelgyro[2], accelgyro[3], accelgyro[4], accelgyro[5], id ); + printf( "I %s %d %d %d %d %d %d %d %d\n", so->codename, timecode, accelgyro[0], accelgyro[1], accelgyro[2], accelgyro[3], accelgyro[4], accelgyro[5], id ); } } |