view rvinterf/packetrx.c @ 143:afceeeb2cba1

Our nuc-fw is destined to become gsm-fw, so I went ahead and did the big hg mv
author Michael Spacefalcon <msokolov@ivan.Harhan.ORG>
date Tue, 12 Nov 2013 05:35:48 +0000
parents 56b53c289785
children
line wrap: on
line source

/*
 * This module handles the lowest level of serial packet Rx
 */

#include <sys/types.h>
#include <stdio.h>
#include <stdlib.h>
#include <unistd.h>
#include "pktmux.h"

extern int target_fd;

#define	MAXPKT	512
u_char rxpkt[MAXPKT];
size_t rxpkt_len;

extern char pr_item[];

static int in_pkt, dle_state, toobig;

static void
process_inbyte(inb)
{
	if (!in_pkt) {
		if (inb != STX || dle_state) {
			rxpkt_len++;
			dle_state = (inb == DLE);
			return;
		}
		if (rxpkt_len) {
			sprintf(pr_item,
				"Warning: Rx %u byte%s outside of a packet",
				(unsigned)rxpkt_len, rxpkt_len != 1 ? "s" : "");
			print_item();
			rxpkt_len = 0;
		}
		in_pkt = 1;
		toobig = 0;
		return;
	}
	if (dle_state) {
		dle_state = 0;
		if (inb != STX && inb != DLE) {
			sprintf(pr_item,
				"Rx framing error: %02X after DLE\n", inb);
			print_item();
			in_pkt = 0;
			rxpkt_len = 0;
			return;
		}
		goto data;
	}
	if (inb == DLE) {
		dle_state = 1;
		return;
	} else if (inb == STX) {
		if (!rxpkt_len)
			return;
		in_pkt = 0;
		handle_rx_packet();
		rxpkt_len = 0;
		return;
	}
data:	if (rxpkt_len >= MAXPKT) {
		if (!toobig) {
			sprintf(pr_item, "Error: Rx packet too big!\n");
			print_item();
			toobig = 1;
		}
		return;
	}
	rxpkt[rxpkt_len++] = inb;
}

void
process_serial_rx()
{
	u_char rdbuf[512];
	int cc, i;

	cc = read(target_fd, rdbuf, sizeof rdbuf);
	if (cc <= 0) {
		perror("Error/EOF reading from target");
		exit(1);
	}
	for (i = 0; i < cc; i++)
		process_inbyte(rdbuf[i]);
}