2 * Asterisk -- An open source telephony toolkit.
4 * Copyright (C) 1999 - 2005, Digium, Inc.
6 * Mark Spencer <markster@digium.com>
8 * Includes code and algorithms from the Zapata library.
10 * See http://www.asterisk.org for more information about
11 * the Asterisk project. Please do not directly contact
12 * any of the maintainers of this project for assistance;
13 * the project provides a web site, mailing lists and IRC
14 * channels for your use.
16 * This program is free software, distributed under the terms of
17 * the GNU General Public License Version 2. See the LICENSE file
18 * at the top of the source tree.
23 * \brief TTY/TDD Generation support
25 * \author Mark Spencer <markster@digium.com>
27 * \note Includes code and algorithms from the Zapata library.
32 ASTERISK_FILE_VERSION(__FILE__
, "$Revision$")
42 #include "asterisk/ulaw.h"
43 #include "asterisk/tdd.h"
44 #include "asterisk/logger.h"
45 #include "asterisk/fskmodem.h"
59 static float dr
[4], di
[4];
60 static float tddsb
= 176.0; /* 45.5 baud */
62 #define TDD_SPACE 1800.0 /* 1800 hz for "0" */
63 #define TDD_MARK 1400.0 /* 1400 hz for "1" */
65 static int tdd_decode_baudot(struct tdd_state
*tdd
,unsigned char data
) /* covert baudot into ASCII */
67 static char ltrs
[32] = { '<','E','\n','A',' ','S','I','U',
68 '\n','D','R','J','N','F','C','K',
69 'T','Z','L','W','H','Y','P','Q',
70 'O','B','G','^','M','X','V','^' };
71 static char figs
[32] = { '<','3','\n','-',' ','\'','8','7',
72 '\n','$','4','\'',',','!',':','(',
73 '5','\"',')','2','=','6','0','1',
74 '9','?','+','^','.','/',';','^' };
75 int d
= 0; /* return 0 if not decodeable */
95 /* Initialize stuff for inverse FFT */
96 dr
[0] = cos(TDD_SPACE
* 2.0 * M_PI
/ 8000.0);
97 di
[0] = sin(TDD_SPACE
* 2.0 * M_PI
/ 8000.0);
98 dr
[1] = cos(TDD_MARK
* 2.0 * M_PI
/ 8000.0);
99 di
[1] = sin(TDD_MARK
* 2.0 * M_PI
/ 8000.0);
102 struct tdd_state
*tdd_new(void)
104 struct tdd_state
*tdd
;
105 tdd
= calloc(1, sizeof(*tdd
));
107 tdd
->fskd
.spb
= 176; /* 45.5 baud */
108 tdd
->fskd
.hdlc
= 0; /* Async */
109 tdd
->fskd
.nbit
= 5; /* 5 bits */
110 tdd
->fskd
.nstop
= 1.5; /* 1.5 stop bits */
111 tdd
->fskd
.paridad
= 0; /* No parity */
112 tdd
->fskd
.bw
=0; /* Filter 75 Hz */
113 tdd
->fskd
.f_mark_idx
= 0; /* 1400 Hz */
114 tdd
->fskd
.f_space_idx
= 1; /* 1800 Hz */
115 tdd
->fskd
.pcola
= 0; /* No clue */
116 tdd
->fskd
.cont
= 0; /* Digital PLL reset */
123 ast_log(LOG_WARNING
, "Out of memory\n");
127 int ast_tdd_gen_ecdisa(unsigned char *outbuf
, int len
)
132 cnt
= len
> sizeof(ecdisa
) ? sizeof(ecdisa
) : len
;
133 memcpy(outbuf
+ pos
, ecdisa
, cnt
);
140 int tdd_feed(struct tdd_state
*tdd
, unsigned char *ubuf
, int len
)
147 short *buf
= calloc(1, 2 * len
+ tdd
->oldlen
);
150 ast_log(LOG_WARNING
, "Out of memory\n");
153 memcpy(buf
, tdd
->oldstuff
, tdd
->oldlen
);
154 mylen
+= tdd
->oldlen
/2;
155 for (x
= 0; x
< len
; x
++)
156 buf
[x
+ tdd
->oldlen
/ 2] = AST_MULAW(ubuf
[x
]);
158 while (mylen
>= 1320) { /* has to have enough to work on */
160 res
= fsk_serie(&tdd
->fskd
, buf
, &mylen
, &b
);
162 ast_log(LOG_ERROR
, "fsk_serial made mylen < 0 (%d) (olen was %d)\n", mylen
, olen
);
166 buf
+= (olen
- mylen
);
168 ast_log(LOG_NOTICE
, "fsk_serial failed\n");
173 /* Ignore invalid bytes */
176 c
= tdd_decode_baudot(tdd
,b
);
177 if ((c
< 1) || (c
> 126))
178 continue; /* if not valid */
183 memcpy(tdd
->oldstuff
, buf
, mylen
* 2);
184 tdd
->oldlen
= mylen
* 2;
190 /* put it in mode where it
191 reliably puts teleprinter in correct shift mode */
197 void tdd_free(struct tdd_state
*tdd
)
202 static inline float tdd_getcarrier(float *cr
, float *ci
, int bit
)
204 /* Move along. There's nothing to see here... */
206 t
= *cr
* dr
[bit
] - *ci
* di
[bit
];
207 *ci
= *cr
* di
[bit
] + *ci
* dr
[bit
];
210 t
= 2.0 - (*cr
* *cr
+ *ci
* *ci
);
216 #define PUT_BYTE(a) do { \
221 #define PUT_AUDIO_SAMPLE(y) do { \
222 int index = (short)(rint(8192.0 * (y))); \
223 *(buf++) = AST_LIN2MU(index); \
227 #define PUT_TDD_MARKMS do { \
230 PUT_AUDIO_SAMPLE(tdd_getcarrier(&cr, &ci, 1)); \
233 #define PUT_TDD_BAUD(bit) do { \
234 while (scont < tddsb) { \
235 PUT_AUDIO_SAMPLE(tdd_getcarrier(&cr, &ci, bit)); \
241 #define PUT_TDD_STOP do { \
242 while (scont < (tddsb * 1.5)) { \
243 PUT_AUDIO_SAMPLE(tdd_getcarrier(&cr, &ci, 1)); \
246 scont -= (tddsb * 1.5); \
250 #define PUT_TDD(byte) do { \
252 unsigned char b = (byte); \
253 PUT_TDD_BAUD(0); /* Start bit */ \
254 for (z = 0; z < 5; z++) { \
255 PUT_TDD_BAUD(b & 1); \
258 PUT_TDD_STOP; /* Stop bit */ \
261 int tdd_generate(struct tdd_state
*tdd
, unsigned char *buf
, const char *str
)
266 /*! Baudot letters */
267 static unsigned char lstr
[31] = "\000E\nA SIU\rDRJNFCKTZLWHYPQOBG\000MXV";
268 /*! Baudot figures */
269 static unsigned char fstr
[31] = "\0003\n- \00787\r$4',!:(5\")2\0006019?+\000./;";
270 /* Initial carriers (real/imaginary) */
275 for(x
= 0; str
[x
]; x
++) {
276 /* Do synch for each 72th character */
277 if ( (tdd
->charnum
++) % 72 == 0)
278 PUT_TDD(tdd
->mode
? 27 /* FIGS */ : 31 /* LTRS */);
282 printf("%c",c
); fflush(stdout
);
284 if (c
== 0) { /* send null */
288 if (c
== '\r') { /* send c/r */
292 if (c
== '\n') { /* send c/r and l/f */
297 if (c
== ' ') { /* send space */
301 for (i
= 0; i
< 31; i
++) {
305 if (i
< 31) { /* if we found it */
306 if (tdd
->mode
) { /* if in figs mode, change it */
307 PUT_TDD(31); /* Send LTRS */
313 for (i
= 0; i
< 31; i
++) {
317 if (i
< 31) { /* if we found it */
318 if (tdd
->mode
!= 1) { /* if in ltrs mode, change it */
319 PUT_TDD(27); /* send FIGS */
322 PUT_TDD(i
); /* send byte */