DD2-monitor/serial/t.c

94 lines
1.9 KiB
C

/*
* Experiments with the serial input
* ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
*/
#include <stdio.h>
#include <stdlib.h>
#include <strings.h>
#include <ctype.h>
#include <time.h>
#include <unistd.h> //Used for UART
#include <fcntl.h> //Used for UART
#include <errno.h>
#include <termios.h> //Used for UART
#include <getopt.h>
#include "serial.h"
int verbosity;
/* ---------------------------------------------------------------- */
int loop(int sfd, int iters)
{
int count, foo;
long temps;
char ligne[200];
float datas[4];
for (count=0; count<iters; count++) {
foo = getline_to(sfd, ligne, 100, 0);
//
if (verbosity > 1) {
fprintf(stderr, "getline #%d -> %d\n", count, foo);
fprintf(stderr, "%s\n", ligne);
}
foo = parse4values(ligne, 'T', datas);
//
if (foo >= 0) {
temps = time(NULL);
values2temps(datas);
printf("%ld %f %f %f %f\n", temps,
datas[0], datas[1], datas[2], datas[3]);
fflush(stdout);
}
else {
fprintf(stderr, "%s: parse -> %d\n", __func__, foo);
}
if (verbosity > 1) fprintf(stderr, "\n");
}
return 0;
}
/* ---------------------------------------------------------------- */
int main (int argc, char *argv[])
{
int serial_in;
char *device;
int nbre, speed, opt;
/* set some default values */
verbosity = 0;
nbre = 25;
speed = 9600;
device = "/dev/ttyACM0";
while ((opt = getopt(argc, argv, "d:n:v")) != -1) {
switch (opt) {
case 'v': verbosity++; break;
case 'n': nbre = atoi(optarg); break;
case 'd': device = optarg; break;
default:
fprintf(stderr, "%s : uh ?", argv[0]);
exit(1);
break;
}
}
serial_in = prepare_UART(device, speed);
if (serial_in < 0) {
fprintf(stderr, "%s : open device : error %d on %s\n",
argv[0], serial_in, device);
exit(1);
}
fprintf(stderr, "going to listen on %d\n", serial_in);
(void)loop(serial_in, nbre);
return 0;
}
/* ---------------------------------------------------------------- */