From fe88ef57cff4971664b252cb9def6a5ddcc4276d Mon Sep 17 00:00:00 2001 From: Justin Berger Date: Fri, 9 Mar 2018 00:41:46 -0700 Subject: Spaces -> Tabs (code formatting change) --- data_recorder.c | 250 ++++++++++++++++++++++++++++---------------------------- 1 file changed, 125 insertions(+), 125 deletions(-) (limited to 'data_recorder.c') diff --git a/data_recorder.c b/data_recorder.c index 63746c3..6123d57 100644 --- a/data_recorder.c +++ b/data_recorder.c @@ -1,204 +1,204 @@ -//Data recorder mod with GUI showing light positions. +// Data recorder mod with GUI showing light positions. #ifdef __linux__ #include #endif +#include +#include +#include +#include #include #include -#include -#include #include -#include -#include -#include +#include #include -#include +#include #include "redist/os_generic.h" -struct SurviveContext * ctx; +struct SurviveContext *ctx; -FILE* output_file = 0; +FILE *output_file = 0; -void HandleKey( int keycode, int bDown ) -{ - if( !bDown ) return; +void HandleKey(int keycode, int bDown) { + if (!bDown) + return; - if( keycode == 'O' || keycode == 'o' ) - { - survive_send_magic(ctx,1,0,0); + if (keycode == 'O' || keycode == 'o') { + survive_send_magic(ctx, 1, 0, 0); } - if( keycode == 'F' || keycode == 'f' ) - { - survive_send_magic(ctx,0,0,0); + if (keycode == 'F' || keycode == 'f') { + survive_send_magic(ctx, 0, 0, 0); } } -void HandleButton( int x, int y, int button, int bDown ) -{ -} +void HandleButton(int x, int y, int button, int bDown) {} -void HandleMotion( int x, int y, int mask ) -{ -} +void HandleMotion(int x, int y, int mask) {} -void HandleDestroy() -{ -} +void HandleDestroy() {} -int bufferpts[32*2*3]; -char buffermts[32*128*3]; -int buffertimeto[32*3]; +int bufferpts[32 * 2 * 3]; +char buffermts[32 * 128 * 3]; +int buffertimeto[32 * 3]; double timestamp_in_us() { - static double start_time_us = 0; - if(start_time_us == 0) - start_time_us = OGGetAbsoluteTime(); - return OGGetAbsoluteTime() - start_time_us; + static double start_time_us = 0; + if (start_time_us == 0) + start_time_us = OGGetAbsoluteTime(); + return OGGetAbsoluteTime() - start_time_us; } -int write_to_output(const char *format, ...) -{ - va_list args; - va_start(args, format); - fprintf(output_file, "%.17g ", timestamp_in_us()); - vfprintf(output_file, format, args); +int write_to_output(const char *format, ...) { + va_list args; + va_start(args, format); + fprintf(output_file, "%.17g ", timestamp_in_us()); + vfprintf(output_file, format, args); - va_end(args); + va_end(args); } -void my_light_process( struct SurviveObject * so, int sensor_id, int acode, int timeinsweep, uint32_t timecode, uint32_t length, uint32_t lh) -{ - survive_default_light_process( so, sensor_id, acode, timeinsweep, timecode, length, lh); +void my_light_process(struct SurviveObject *so, int sensor_id, int acode, + int timeinsweep, uint32_t timecode, uint32_t length, + uint32_t lh) { + survive_default_light_process(so, sensor_id, acode, timeinsweep, timecode, + length, lh); - if( acode == -1 ) { - write_to_output( "A %s %d %d %d %u %u %u\n", so->codename, sensor_id, acode, timeinsweep, timecode, length, lh ); - return; + if (acode == -1) { + write_to_output("A %s %d %d %d %u %u %u\n", so->codename, sensor_id, + acode, timeinsweep, timecode, length, lh); + return; } int jumpoffset = sensor_id; - if( strcmp( so->codename, "WM0" ) == 0 ) jumpoffset += 32; - else if( strcmp( so->codename, "WM1" ) == 0 ) jumpoffset += 64; + if (strcmp(so->codename, "WM0") == 0) + jumpoffset += 32; + else if (strcmp(so->codename, "WM1") == 0) + jumpoffset += 64; + + const char *LH_ID = 0; + const char *LH_Axis = 0; - const char* LH_ID = 0; - const char* LH_Axis = 0; - - switch(acode) { + switch (acode) { case 0: case 2: - bufferpts[jumpoffset*2+0] = (timeinsweep-100000)/500; - LH_ID = "L"; LH_Axis = "X"; break; + bufferpts[jumpoffset * 2 + 0] = (timeinsweep - 100000) / 500; + LH_ID = "L"; + LH_Axis = "X"; + break; case 1: case 3: - bufferpts[jumpoffset*2+1] = (timeinsweep-100000)/500; - LH_ID = "L"; LH_Axis = "Y"; break; + bufferpts[jumpoffset * 2 + 1] = (timeinsweep - 100000) / 500; + LH_ID = "L"; + LH_Axis = "Y"; + break; case 4: case 6: - bufferpts[jumpoffset*2+0] = (timeinsweep-100000)/500; - LH_ID = "R"; LH_Axis = "X"; break; + bufferpts[jumpoffset * 2 + 0] = (timeinsweep - 100000) / 500; + LH_ID = "R"; + LH_Axis = "X"; + break; case 5: case 7: - bufferpts[jumpoffset*2+1] = (timeinsweep-100000)/500; - LH_ID = "R"; LH_Axis = "Y"; break; - } + bufferpts[jumpoffset * 2 + 1] = (timeinsweep - 100000) / 500; + LH_ID = "R"; + LH_Axis = "Y"; + break; + } - write_to_output( "%s %s %s %u %d %d %d %u %u\n", LH_ID, LH_Axis, so->codename, timecode, sensor_id, acode, timeinsweep, length, lh ); + write_to_output("%s %s %s %u %d %d %d %u %u\n", LH_ID, LH_Axis, + so->codename, timecode, sensor_id, acode, timeinsweep, + length, lh); buffertimeto[jumpoffset] = 0; - } -void my_imu_process( struct SurviveObject * so, int mask, FLT * accelgyro, uint32_t timecode, int id ) -{ - survive_default_imu_process( so, mask, accelgyro, timecode, id ); - write_to_output( "I %s %d %u %.17g %.17g %.17g %.17g %.17g %.17g %d\n", so->codename, mask, timecode, accelgyro[0], accelgyro[1], accelgyro[2], accelgyro[3], accelgyro[4], accelgyro[5], id ); +void my_imu_process(struct SurviveObject *so, int mask, FLT *accelgyro, + uint32_t timecode, int id) { + survive_default_imu_process(so, mask, accelgyro, timecode, id); + write_to_output("I %s %d %u %.17g %.17g %.17g %.17g %.17g %.17g %d\n", + so->codename, mask, timecode, accelgyro[0], accelgyro[1], + accelgyro[2], accelgyro[3], accelgyro[4], accelgyro[5], id); } - - - -void * GuiThread( void * v ) -{ +void *GuiThread(void *v) { CNFGBGColor = 0x000000; CNFGDialogColor = 0x444444; - CNFGSetup( "Survive GUI Debug", 640, 480 ); + CNFGSetup("Survive GUI Debug", 640, 480); short screenx, screeny; - while(1) - { + while (1) { CNFGHandleInput(); CNFGClearFrame(); - CNFGColor( 0xFFFFFF ); - CNFGGetDimensions( &screenx, &screeny ); + CNFGColor(0xFFFFFF); + CNFGGetDimensions(&screenx, &screeny); int i; - for( i = 0; i < 32*3; i++ ) - { - if( buffertimeto[i] < 50 ) - { + for (i = 0; i < 32 * 3; i++) { + if (buffertimeto[i] < 50) { uint32_t color = i * 3231349; uint8_t r = color & 0xff; - uint8_t g = (color>>8) & 0xff; - uint8_t b = (color>>16) & 0xff; - r = (r * (5-buffertimeto[i])) / 5 ; - g = (g * (5-buffertimeto[i])) / 5 ; - b = (b * (5-buffertimeto[i])) / 5 ; - CNFGColor( (b<<16) | (g<<8) | r ); - CNFGTackRectangle( bufferpts[i*2+0], bufferpts[i*2+1], bufferpts[i*2+0] + 5, bufferpts[i*2+1] + 5 ); - CNFGPenX = bufferpts[i*2+0]; CNFGPenY = bufferpts[i*2+1]; - CNFGDrawText( buffermts, 2 ); + uint8_t g = (color >> 8) & 0xff; + uint8_t b = (color >> 16) & 0xff; + r = (r * (5 - buffertimeto[i])) / 5; + g = (g * (5 - buffertimeto[i])) / 5; + b = (b * (5 - buffertimeto[i])) / 5; + CNFGColor((b << 16) | (g << 8) | r); + CNFGTackRectangle(bufferpts[i * 2 + 0], bufferpts[i * 2 + 1], + bufferpts[i * 2 + 0] + 5, + bufferpts[i * 2 + 1] + 5); + CNFGPenX = bufferpts[i * 2 + 0]; + CNFGPenY = bufferpts[i * 2 + 1]; + CNFGDrawText(buffermts, 2); buffertimeto[i]++; } } CNFGSwapBuffers(); - OGUSleep( 10000 ); + OGUSleep(10000); } } -int SurviveThreadLoaded=0; +int SurviveThreadLoaded = 0; -void *SurviveThread(void *junk) -{ - ctx = survive_init( 0 ); +void *SurviveThread(void *junk) { + ctx = survive_init(0); - survive_install_light_fn( ctx, my_light_process ); - survive_install_imu_fn( ctx, my_imu_process ); + survive_install_light_fn(ctx, my_light_process); + survive_install_imu_fn(ctx, my_imu_process); - if( !ctx ) - { - fprintf( stderr, "Fatal. Could not start\n" ); + if (!ctx) { + fprintf(stderr, "Fatal. Could not start\n"); exit(1); } SurviveThreadLoaded = 1; - while(survive_poll(ctx) == 0) - { + while (survive_poll(ctx) == 0) { } - return 0; + return 0; } -int main(int argc, char** argv) -{ - if(argc > 1) { - output_file = fopen(argv[1], "w"); - if(output_file == 0) { - fprintf(stderr, "Could not open %s for writing", argv[1]); - return -1; - } - } else { - output_file = stdout; - } - - // Create the libsurvive thread - OGCreateThread(SurviveThread, 0); - - // Wait for the survive thread to load - while (!SurviveThreadLoaded) { OGUSleep(100); } - - // Run the Gui in the main thread - GuiThread(0); -} +int main(int argc, char **argv) { + if (argc > 1) { + output_file = fopen(argv[1], "w"); + if (output_file == 0) { + fprintf(stderr, "Could not open %s for writing", argv[1]); + return -1; + } + } else { + output_file = stdout; + } + + // Create the libsurvive thread + OGCreateThread(SurviveThread, 0); + // Wait for the survive thread to load + while (!SurviveThreadLoaded) { + OGUSleep(100); + } + + // Run the Gui in the main thread + GuiThread(0); +} -- cgit v1.2.3