dahdi-tools/hdlcgen.c

136 lines
3.5 KiB
C

/*
* Written by Mark Spencer <markster@digium.com>
* Based on previous works, designs, and architectures conceived and
* written by Jim Dixon <jim@lambdatel.com>.
*
* Copyright (C) 2001 Jim Dixon / Zapata Telephony.
* Copyright (C) 2001-2008 Digium, Inc.
*
* All rights reserved.
*
* Primary Author: Mark Spencer <markster@digium.com>
* Radio Support by Jim Dixon <jim@lambdatel.com>
*/
/*
* See http://www.asterisk.org for more information about
* the Asterisk project. Please do not directly contact
* any of the maintainers of this project for assistance;
* the project provides a web site, mailing lists and IRC
* channels for your use.
*
* This program is free software, distributed under the terms of
* the GNU General Public License Version 2 as published by the
* Free Software Foundation. See the LICENSE file included with
* this program for more details.
*/
#include <stdio.h>
#include <fcntl.h>
#include <string.h>
#include <errno.h>
#include <unistd.h>
#include <stdlib.h>
#define FAST_HDLC_NEED_TABLES
#include <dahdi/fasthdlc.h>
#include "dahdi_tools_version.h"
#define RANDOM "/dev/urandom" /* Not genuinely random */
/* #define RANDOM "/dev/random" */ /* Quite genuinely random */
int myread(int fd, unsigned 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;
}
int main(int argc, char *argv[])
{
unsigned char buf[1024];
unsigned char outbuf[2048];
int res;
int randin;
int randout;
int hdlcout;
int cnt;
int hdlccnt;
int x;
int flags;
struct fasthdlc_state transmitter;
fasthdlc_precalc();
fasthdlc_init(&transmitter, FASTHDLC_MODE_64);
randin = open(RANDOM, O_RDONLY);
if (randin < 0) {
fprintf(stderr, "Unable to open %s: %s\n", RANDOM, strerror(errno));
exit(1);
}
randout = open("random.raw", O_WRONLY|O_TRUNC|O_CREAT, 0666);
if (randout < 0) {
fprintf(stderr, "Unable to open random.raw: %s\n", strerror(errno));
exit(1);
}
hdlcout = open("random.hdlc", O_WRONLY|O_TRUNC|O_CREAT, 0666);
if (hdlcout < 0) {
fprintf(stderr, "Unable to open random.hdlc: %s\n", strerror(errno));
exit(1);
}
for (;;) {
cnt = (rand() % 256) + 4; /* Read a pseudo-random amount of stuff */
res = myread(randin, buf, cnt);
if (res != cnt) {
fprintf(stderr, "Tried to read %d bytes, but read %d instead\n", cnt, res);
exit(1);
}
res = write(randout, buf, cnt);
if (res != cnt) {
fprintf(stderr, "Tried to write %d bytes, but wrote %d instead\n", cnt, res);
exit(1);
}
/* HDLC encode */
hdlccnt = 0;
/* Start with a flag */
fasthdlc_tx_frame(&transmitter);
if (transmitter.bits >= 8)
outbuf[hdlccnt++] = fasthdlc_tx_run(&transmitter);
for (x=0;x<cnt;x++) {
res = fasthdlc_tx_load(&transmitter, buf[x]);
if (res < 0) {
fprintf(stderr, "Unable to load byte :(\n");
exit(1);
}
while(transmitter.bits >= 8) {
outbuf[hdlccnt++] = fasthdlc_tx_run(&transmitter);
}
}
flags = (rand() % 4);
for (x=0;x<flags;x++) {
if (transmitter.bits < 8)
fasthdlc_tx_frame(&transmitter);
else
fprintf(stderr, "Huh? Don't need a frame?\n");
outbuf[hdlccnt++] = fasthdlc_tx_run(&transmitter);
}
if (argc > 1)
printf("Encoded %d byte message with %d bytes of HDLC and %d extra flags\n", cnt, hdlccnt, flags);
res = write(hdlcout, outbuf, hdlccnt);
if (res != hdlccnt) {
fprintf(stderr, "Tried to write %d HDLC bytes, but wrote %d instead\n", cnt, res);
exit(1);
}
}
}