blob: 42a1f72cf64134016875bb1bb4043f99ce86d70a (
plain)
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
|
/* Thinger to read 60hz cycle times and display diagnostics in a kind
* of stripcharty way.
*/
#include <unistd.h>
#include <stdio.h>
#include <string.h>
#include <fcntl.h>
#define QUEUE 60
#define WIDTH 40
int main(int *argc, char **argv)
{
char line[WIDTH + 10];
char blankline[] = " | ";
double bottom = 1000000/59.9;
double top = 1000000/60.1;
double center = 1000000/60;
double queue[QUEUE];
int counter;
int qpos = 0;
int fd = open("/dev/ttyACM0", O_RDONLY);
strcpy(&line, &blankline);
while (1) {
double current, average;
char inlin[20];
int position, pos_avg, i;
int len = read(fd, &inlin, 20);
if (len == 0) {
puts("Fucked\n");
continue;
}
current = (double)atoi(&inlin);
queue[qpos++] = current;
counter++;
if (qpos == QUEUE)
qpos = 0;
average = 0;
for (i = 0; i < QUEUE; i++) {
average += queue[i];
}
average /= QUEUE;
pos_avg = WIDTH-(int)((top-average)/((top-bottom)/WIDTH));
position = WIDTH-(int)((top-current)/((top-bottom)/WIDTH));
if (position > WIDTH) {
line[WIDTH] = '>';
} else if (position < 0) {
line[0] = '<';
} else {
line[position] = '.';
}
if (counter % 6 == 0) {
if (pos_avg > WIDTH) {
line[WIDTH] = '_';
} else if (pos_avg < 0) {
line[0] = '_';
} else {
line[pos_avg] = '#';
}
printf("[%s] %f\n", line, 1/(average/1000000));
strcpy(&line, &blankline);
}
}
}
|
