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

tools/: -S now dumps samples to stdout; -S -S produces graphical output

Browse Source
This commit is contained in:
Werner Almesberger 2012-06-23 14:35:44 -03:00
parent 2f120fa683
commit 5b1f722568
1 changed files with 30 additions and 12 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

42
tools/antorcha.c
View File

@ -16,6 +16,7 @@
#include <stdio.h> #include <stdio.h>
#include <unistd.h> #include <unistd.h>
#include <string.h> #include <string.h>
#include <signal.h>
#include <assert.h> #include <assert.h>
#include <at86rf230.h> #include <at86rf230.h>
@ -280,6 +281,15 @@ static void image(struct atrf_dsc *dsc, const char *name)
/* ----- Samples ----------------------------------------------------------- */ /* ----- Samples ----------------------------------------------------------- */
static volatile int run = 1;
static void sigint(int sig)
{
run = 0;
}
static int read_sample(uint8_t **s, uint16_t *t_high, uint16_t *t_low, static int read_sample(uint8_t **s, uint16_t *t_high, uint16_t *t_low,
uint16_t *last) uint16_t *last)
{ {
@ -296,18 +306,22 @@ static int read_sample(uint8_t **s, uint16_t *t_high, uint16_t *t_low,
} }
static void samples(struct atrf_dsc *dsc) static void samples(struct atrf_dsc *dsc, int gui)
{ {
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; uint16_t t_high, t_low, last;
int x, y; int x, y;
double t;
buf[0] = 1; buf[0] = 1;
packet(dsc, SAMPLE, 0, 0, buf, PAYLOAD); packet(dsc, SAMPLE, 0, 0, buf, PAYLOAD);
plot_init(); if (gui)
while (1) { plot_init();
else
signal(SIGINT, sigint);
while (run) {
got = rf_recv(dsc, buf, sizeof(buf)); got = rf_recv(dsc, buf, sizeof(buf));
if (got <= 3) if (got <= 3)
continue; continue;
@ -328,16 +342,20 @@ static void samples(struct atrf_dsc *dsc)
last = 0; last = 0;
while (s < buf+got-2) { while (s < buf+got-2) {
x = read_sample(&s, &t_high, &t_low, &last); x = read_sample(&s, &t_high, &t_low, &last);
t = (t_high << 16 | t_low)/1000000.0;
if (debug) if (debug)
fprintf(stderr, "\t%11.6f %d", fprintf(stderr, "\t%11.6f %d", t, x);
(t_high << 16 | t_low)/1000000.0, x); if (!gui)
printf("%11.6f\t%d\t", t, x);
y = read_sample(&s, &t_high, &t_low, &last); y = read_sample(&s, &t_high, &t_low, &last);
t = (t_high << 16 | t_low)/1000000.0;
if (debug) if (debug)
fprintf(stderr, "\t%11.6f %d\n", fprintf(stderr, "\t%11.6f %d\n", t, y);
(t_high << 16 | t_low)/1000000.0, y); if (!gui)
printf("%11.6f\t%d\n", t, y);
if (!plot(x, y)) if (gui && !plot(x, y))
goto quit; goto quit;
} }
} }
@ -356,7 +374,7 @@ static void usage(const char *name)
"usage: %s [-d] image_file\n" "usage: %s [-d] image_file\n"
"%6s %s [-d] -F firmware_file\n" "%6s %s [-d] -F firmware_file\n"
"%6s %s [-d] -P\n" "%6s %s [-d] -P\n"
"%6s %s [-d] -S\n" "%6s %s [-d] -S [-S]\n"
, name, "", name, "", name, "", name); , name, "", name, "", name, "", name);
exit(1); exit(1);
} }
@ -381,13 +399,13 @@ int main(int argc, char **argv)
do_ping = 1; do_ping = 1;
break; break;
case 'S': case 'S':
do_sample = 1; do_sample++;
break; break;
default: default:
usage(*argv); usage(*argv);
} }
if (do_ping+do_sample+!!fw > 1) if (do_ping+!!do_sample+!!fw > 1)
usage(*argv); usage(*argv);
if (do_ping || do_sample || fw) { if (do_ping || do_sample || fw) {
if (argc != optind) if (argc != optind)
@ -405,7 +423,7 @@ int main(int argc, char **argv)
if (do_ping) if (do_ping)
ping(dsc); ping(dsc);
else if (do_sample) else if (do_sample)
samples(dsc); samples(dsc, do_sample > 1);
else if (fw) else if (fw)
firmware(dsc, fw); firmware(dsc, fw);
else else