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
|
//Data recorder mod with GUI showing light positions.
#include <unistd.h>
#include <stdio.h>
#include <stdlib.h>
#include <stdint.h>
#include <survive.h>
#include <string.h>
#include <os_generic.h>
#include <DrawFunctions.h>
struct SurviveContext * ctx;
void HandleKey( int keycode, int bDown )
{
if( !bDown ) return;
if( keycode == 'O' || keycode == 'o' )
{
survive_usb_send_magic(ctx,1);
}
if( keycode == 'F' || keycode == 'f' )
{
survive_usb_send_magic(ctx,0);
}
}
void HandleButton( int x, int y, int button, int bDown )
{
}
void HandleMotion( int x, int y, int mask )
{
}
int bufferpts[32*2*3];
char buffermts[32*128*3];
int buffertimeto[32*3];
void my_light_process( struct SurviveObject * so, int sensor_id, int acode, int timeinsweep, uint32_t timecode, uint32_t length )
{
survive_default_light_process( so, sensor_id, acode, timeinsweep, timecode, length );
}
void my_imu_process( struct SurviveObject * so, int16_t * accelgyro, uint32_t timecode, int id )
{
survive_default_imu_process( so, accelgyro, timecode, id );
return;
//if( so->codename[0] == 'H' )
if( 1 )
{
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 );
}
}
void * GuiThread( void * v )
{
short screenx, screeny;
while(1)
{
CNFGHandleInput();
CNFGClearFrame();
CNFGColor( 0xFFFFFF );
CNFGGetDimensions( &screenx, &screeny );
int i;
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 );
buffertimeto[i]++;
}
}
CNFGSwapBuffers();
OGUSleep( 10000 );
}
}
int main()
{
ctx = survive_init( );
survive_install_light_fn( ctx, my_light_process );
survive_install_imu_fn( ctx, my_imu_process );
survive_cal_install( ctx );
CNFGBGColor = 0x000000;
CNFGDialogColor = 0x444444;
CNFGSetup( "Survive GUI Debug", 640, 480 );
OGCreateThread( GuiThread, 0 );
if( !ctx )
{
fprintf( stderr, "Fatal. Could not start\n" );
return 1;
}
while(survive_poll(ctx) == 0)
{
//Do stuff.
}
}
|
