forked from asterisk/dahdi-tools
-
Notifications
You must be signed in to change notification settings - Fork 0
/
hdlcgen.c
135 lines (124 loc) · 3.48 KB
/
hdlcgen.c
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
/*
* Written by Mark Spencer <[email protected]>
* Based on previous works, designs, and architectures conceived and
* written by Jim Dixon <[email protected]>.
*
* Copyright (C) 2001 Jim Dixon / Zapata Telephony.
* Copyright (C) 2001-2008 Digium, Inc.
*
* All rights reserved.
*
* Primary Author: Mark Spencer <[email protected]>
* Radio Support by Jim Dixon <[email protected]>
*/
/*
* 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);
}
}
}