hdlcverify.c

This a SOFTWARE pbx DRIVER

#define FAST_HDLC_NEED_TABLES
#include "fasthdlc.h"
#include <stdio.h>
#include <fcntl.h>
#include <string.h>
#include <errno.h>
#include <unistd.h>
#include <stdlib.h>

int myread(int fd, char *buf, int len)
{
	int sofar;
	int res;
	sofar = 0;
	while(sofar < len) {
		res = read(fd, buf + sofar, len - sofar);
		if (res < 0)
			return res;
		sofar += res;
	}
	return sofar;
}

static inline unsigned char nextchar(int fd)
{
	static unsigned char inbuf[2048];
	static int bytes = 0;
	static int pos = 0;
	if (pos >= bytes) {
		pos = 0;
		bytes = read(fd, inbuf, sizeof(inbuf));
		if (bytes < 0) {
			fprintf(stderr, "Unable to read more data: %s\n", strerror(errno));
			exit(1);
		}
		if (bytes == 0) {
			fprintf(stderr, "-- END OF DATA --\n");
			exit(0);
		}
	}
	return inbuf[pos++];
}

int main(int argc, char *argv[])
{
	unsigned char decbuf[1024];
	unsigned char actual[1024];
	int res;
	int datain;
	int hdlcin;
	int hdlccnt;
	int x;
	struct fasthdlc_state receiver;
	
	fasthdlc_precalc();
	
	fasthdlc_init(&receiver);
	
	hdlcin = open("random.hdlc", O_RDONLY);
	if (hdlcin < 0) {
		fprintf(stderr, "Unable to open %s: %s\n", "random.hdlc", strerror(errno));
		exit(1);
	}
	datain = open("random.raw", O_RDONLY);
	if (datain < 0) {
		fprintf(stderr, "Unable to open random.raw: %s\n", strerror(errno));
		exit(1);
	}
	hdlccnt = 0;
	for (;;) {
		/* Feed in some input */
		if (fasthdlc_rx_load(&receiver, nextchar(hdlcin))) {
			fprintf(stderr, "Unable to feed receiver :(\n");
			exit(1);
		}
		res = fasthdlc_rx_run(&receiver);
		if (res & RETURN_EMPTY_FLAG)
			continue;
		if (res & RETURN_COMPLETE_FLAG) {
			if (hdlccnt) {
				if (argc > 1)
					printf("Got message of length %d\n", hdlccnt);
				res = myread(datain, actual, hdlccnt);
				if (res != hdlccnt) {
					fprintf(stderr, "Tried to read %d bytes, but read %d instead\n", hdlccnt, res);
					exit(1);
				}
				for (x=0;x<hdlccnt;x++) {
					if (actual[x] != decbuf[x]) {
						fprintf(stderr, "Found discrepancy at offset %d\n", x);
						exit(1);
					}
				}
				/* Reset message receiver */
				hdlccnt = 0;
			}
		} else if (res & RETURN_DISCARD_FLAG) {
			if (1 || hdlccnt) {
				fprintf(stderr, "Detected abort :(\n");
				exit(1);
			}
		} else {
			decbuf[hdlccnt++] = res;
		}
	}
}