fomu-factory-test/jig/bin/uart-monitor.c
Sean Cross 946c7f8ec1 jig: add jig information
Signed-off-by: Sean Cross <sean@xobs.io>
2019-05-24 19:10:37 +08:00

64 lines
1.1 KiB
C

#include <stdio.h>
#include <stdint.h>
#include <stdlib.h>
#include <unistd.h>
#include <sys/stat.h>
#include <sys/types.h>
#include <fcntl.h>
#include <string.h>
#include <termios.h>
int main(int argc, char **argv) {
FILE *log = NULL;
struct termios tty;
int i;
FILE *fd;
if (argc > 1) {
log = fopen(argv[1], "wb");
if (!log) {
perror("Couldn't open log");
return 1;
}
}
for (i = 0; i < 65536; i++) {
fd = fopen("/dev/ttyACM0", "rb");
if (fd) {
break;
}
usleep(1);
}
if (!fd) {
fprintf(stderr, "Unable to open after %d tries\n", i);
perror("Couldn't open!");
return 1;
}
tcgetattr(fileno(fd), &tty);
cfmakeraw(&tty);
tty.c_cflag &= ~CSTOPB;
tty.c_cflag &= ~CRTSCTS; /* no HW flow control */
tty.c_cflag |= CLOCAL | CREAD;
tcsetattr(fileno(fd), TCSANOW, &tty);
while (1) {
char in_bfr[1024];
memset(in_bfr, 0, sizeof(in_bfr));
if (!fgets(in_bfr, sizeof(in_bfr), fd)) {
return 1;
}
printf("%s", in_bfr);
if (log)
fprintf(log, "%s", in_bfr);
if (!strncmp(in_bfr, "FOMU:", strlen("FOMU:"))) {
break;
}
}
return 0;
}