qi-hardware/antorcha
1
0
Fork 0
mirror of git://projects.qi-hardware.com/antorcha.git synced 2024-11-23 02:23:09 +02:00
Code

tools/antorcha.c (samples): show the timestamp when printing sample values

Browse Source
This commit is contained in:
Werner Almesberger 2012-06-21 19:18:07 -03:00
parent 28cf696a08
commit ea994c8ed0
1 changed files with 24 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

28
tools/antorcha.c
View File

@ -285,6 +285,7 @@ static void samples(struct atrf_dsc *dsc)
uint8_t buf[MAX_PSDU] = { 0, }; uint8_t buf[MAX_PSDU] = { 0, };
int got; int got;
uint8_t *s; uint8_t *s;
uint16_t t_high, t_low, last;
int x, y; int x, y;
buf[0] = 1; buf[0] = 1;
@ -305,16 +306,35 @@ static void samples(struct atrf_dsc *dsc)
} }
if (debug) if (debug)
fprintf(stderr, "%d:", got); fprintf(stderr, "%d:", got);
s = buf+3+2; s = buf+3;
t_high = *s++;
t_high |= *s++ << 8;
last = 0;
while (s < buf+got-2) { while (s < buf+got-2) {
s += 2; t_low = *s++;
t_low |= *s++ << 8;
if (t_low < last)
t_high++;
last = t_low;
x = *s++; x = *s++;
x |= *s++ << 8; x |= *s++ << 8;
s += 2;
if (debug)
fprintf(stderr, "\t%11.6f %d",
(t_high << 16 | t_low)/1000000.0, x);
t_low = *s++;
t_low |= *s++ << 8;
if (t_low < last)
t_high++;
last = t_low;
y = *s++; y = *s++;
y |= *s++ << 8; y |= *s++ << 8;
if (debug) if (debug)
fprintf(stderr, "\t%d %d\n", x, y); fprintf(stderr, "\t%11.6f %d\n",
(t_high << 16 | t_low)/1000000.0, y);
if (!plot(x, y)) if (!plot(x, y))
goto quit; goto quit;
} }