view sw/mcsi-rx/mainloop.c @ 8:ee14dd81bba1

sw/Makefile: add mcsi-rxtx
author Mychaela Falconia <falcon@freecalypso.org>
date Mon, 28 Oct 2024 01:45:32 +0000
parents de85c3680d7e
children
line wrap: on
line source

/*
 * This module holds our main loop code, factored out into a separate
 * function that is called from main() after initialization.
 */

#include <sys/types.h>
#include <sys/time.h>
#include <sys/errno.h>
#include <stdio.h>
#include <stdlib.h>
#include <unistd.h>

extern int target_fd;
extern FILE *out_binfile;

main_loop()
{
	fd_set fds;
	struct timeval tv;
	u_char buf[320];
	unsigned off;
	int cc, is_active;

	is_active = 0;
	off = 0;
	for (;;) {
		FD_ZERO(&fds);
		FD_SET(target_fd, &fds);
		if (is_active) {
			tv.tv_sec = 0;
			tv.tv_usec = 100000;
			cc = select(target_fd+1, &fds, 0, 0, &tv);
		} else
			cc = select(target_fd+1, &fds, 0, 0, 0);
		if (cc < 0) {
			if (errno == EINTR)
				continue;
			perror("select");
			exit(1);
		}
		if (cc == 0) {
			is_active = 0;
			fflush(out_binfile);
			printf("Rx stream stopped, buffer dribble = %u\n", off);
			off = 0;
			continue;
		}
		cc = read(target_fd, buf + off, sizeof(buf) - off);
		if (cc < 0) {
			perror("serial port read");
			exit(1);
		}
		if (cc == 0) {
			fprintf(stderr, "read EOF from serial port\n");
			exit(1);
		}
		if (!is_active) {
			printf("Rx stream started\n");
			is_active = 1;
		}
		off += cc;
		if (off >= sizeof(buf)) {
			process_rx_block(buf);
			off = 0;
		}
	}
}