Documentation / whitespace fix.
[asterisk/asterisk.git] / tdd.c
1 /*
2  * Asterisk -- An open source telephony toolkit.
3  *
4  * Copyright (C) 1999 - 2005, Digium, Inc.
5  *
6  * Mark Spencer <markster@digium.com>
7  *
8  * Includes code and algorithms from the Zapata library.
9  *
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.
15  *
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.
19  */
20
21 /*! \file
22  *
23  * \brief TTY/TDD Generation support 
24  *
25  * \author Mark Spencer <markster@digium.com>
26  *
27  * \note Includes code and algorithms from the Zapata library.
28  */
29
30 #include <time.h>
31 #include <string.h>
32 #include <stdio.h>
33 #include <stdlib.h>
34 #include <unistd.h>
35 #include <math.h>
36 #include <ctype.h>
37
38 #include "asterisk.h"
39
40 ASTERISK_FILE_VERSION(__FILE__, "$Revision$")
41
42 #include "asterisk/ulaw.h"
43 #include "asterisk/tdd.h"
44 #include "asterisk/logger.h"
45 #include "asterisk/fskmodem.h"
46 #include "ecdisa.h"
47
48 struct tdd_state {
49         fsk_data fskd;
50         char rawdata[256];
51         short oldstuff[4096];
52         int oldlen;
53         int pos;
54         int modo;
55         int mode;
56 };
57
58 static float dr[4], di[4];
59 static float tddsb = 176.0;  /* 45.5 baud */
60
61 #define TDD_SPACE       1800.0          /* 1800 hz for "0" */
62 #define TDD_MARK        1400.0          /* 1400 hz for "1" */
63
64 static int tdd_decode_baudot(struct tdd_state *tdd,unsigned char data)  /* covert baudot into ASCII */
65 {
66         static char ltrs[32]={'<','E','\n','A',' ','S','I','U',
67                                 '\n','D','R','J','N','F','C','K',
68                                 'T','Z','L','W','H','Y','P','Q',
69                                 'O','B','G','^','M','X','V','^'};
70         static char figs[32]={'<','3','\n','-',' ',',','8','7',
71                                 '\n','$','4','\'',',','·',':','(',
72                                 '5','+',')','2','·','6','0','1',
73                                 '9','7','·','^','.','/','=','^'};
74         int d;
75         d=0;  /* return 0 if not decodeable */
76         switch (data) {
77         case 0x1f :     tdd->modo=0; break;
78         case 0x1b : tdd->modo=1; break;
79         default:        if (tdd->modo==0) d=ltrs[data]; else d=figs[data]; break;
80         }
81         return d;
82 }
83
84 void tdd_init(void)
85 {
86         /* Initialize stuff for inverse FFT */
87         dr[0] = cos(TDD_SPACE * 2.0 * M_PI / 8000.0);
88         di[0] = sin(TDD_SPACE * 2.0 * M_PI / 8000.0);
89         dr[1] = cos(TDD_MARK * 2.0 * M_PI / 8000.0);
90         di[1] = sin(TDD_MARK * 2.0 * M_PI / 8000.0);
91 }
92
93 struct tdd_state *tdd_new(void)
94 {
95         struct tdd_state *tdd;
96         tdd = malloc(sizeof(struct tdd_state));
97         if (tdd) {
98                 memset(tdd, 0, sizeof(struct tdd_state));
99                 tdd->fskd.spb = 176;            /* 45.5 baud */
100                 tdd->fskd.hdlc = 0;             /* Async */
101                 tdd->fskd.nbit = 5;             /* 5 bits */
102                 tdd->fskd.nstop = 1.5;  /* 1.5 stop bits */
103                 tdd->fskd.paridad = 0;  /* No parity */
104                 tdd->fskd.bw=0;                 /* Filter 75 Hz */
105                 tdd->fskd.f_mark_idx =  0;      /* 1400 Hz */
106                 tdd->fskd.f_space_idx = 1;      /* 1800 Hz */
107                 tdd->fskd.pcola = 0;            /* No clue */
108                 tdd->fskd.cont = 0;                     /* Digital PLL reset */
109                 tdd->fskd.x0 = 0.0;
110                 tdd->fskd.state = 0;
111                 tdd->pos = 0;
112                 tdd->mode = 2;
113         } else
114                 ast_log(LOG_WARNING, "Out of memory\n");
115         return tdd;
116 }
117
118 int ast_tdd_gen_ecdisa(unsigned char *outbuf, int len)
119 {
120         int pos = 0;
121         int cnt;
122         while(len) {
123                 cnt = len;
124                 if (cnt > sizeof(ecdisa))
125                         cnt = sizeof(ecdisa);
126                 memcpy(outbuf + pos, ecdisa, cnt);
127                 pos += cnt;
128                 len -= cnt;
129         }
130         return 0;
131 }
132
133 int tdd_feed(struct tdd_state *tdd, unsigned char *ubuf, int len)
134 {
135         int mylen = len;
136         int olen;
137         int b = 'X';
138         int res;
139         int c,x;
140         short *buf = malloc(2 * len + tdd->oldlen);
141         short *obuf = buf;
142         if (!buf) {
143                 ast_log(LOG_WARNING, "Out of memory\n");
144                 return -1;
145         }
146         memset(buf, 0, 2 * len + tdd->oldlen);
147         memcpy(buf, tdd->oldstuff, tdd->oldlen);
148         mylen += tdd->oldlen/2;
149         for (x=0;x<len;x++) 
150                 buf[x+tdd->oldlen/2] = AST_MULAW(ubuf[x]);
151         c = res = 0;
152         while(mylen >= 1320) { /* has to have enough to work on */
153                 olen = mylen;
154                 res = fsk_serie(&tdd->fskd, buf, &mylen, &b);
155                 if (mylen < 0) {
156                         ast_log(LOG_ERROR, "fsk_serie made mylen < 0 (%d) (olen was %d)\n", mylen,olen);
157                         free(obuf);
158                         return -1;
159                 }
160                 buf += (olen - mylen);
161                 if (res < 0) {
162                         ast_log(LOG_NOTICE, "fsk_serie failed\n");
163                         free(obuf);
164                         return -1;
165                 }
166                 if (res == 1) {
167                         /* Ignore invalid bytes */
168                         if (b > 0x7f)
169                                 continue;
170                         c = tdd_decode_baudot(tdd,b);
171                         if ((c < 1) || (c > 126)) continue; /* if not valid */
172                         break;
173                 }
174         }
175         if (mylen) {
176                 memcpy(tdd->oldstuff, buf, mylen * 2);
177                 tdd->oldlen = mylen * 2;
178         } else
179                 tdd->oldlen = 0;
180         free(obuf);
181         if (res)  {
182                 tdd->mode = 2; /* put it in mode where it
183                         reliably puts teleprinter in correct shift mode */
184                 return(c);
185         }
186         return 0;
187 }
188
189 void tdd_free(struct tdd_state *tdd)
190 {
191         free(tdd);
192 }
193
194 static inline float tdd_getcarrier(float *cr, float *ci, int bit)
195 {
196         /* Move along.  There's nothing to see here... */
197         float t;
198         t = *cr * dr[bit] - *ci * di[bit];
199         *ci = *cr * di[bit] + *ci * dr[bit];
200         *cr = t;
201         
202         t = 2.0 - (*cr * *cr + *ci * *ci);
203         *cr *= t;
204         *ci *= t;
205         return *cr;
206 }       
207
208 #define PUT_BYTE(a) do { \
209         *(buf++) = (a); \
210         bytes++; \
211 } while(0)
212
213 #define PUT_AUDIO_SAMPLE(y) do { \
214         int index = (short)(rint(8192.0 * (y))); \
215         *(buf++) = AST_LIN2MU(index); \
216         bytes++; \
217 } while(0)
218         
219 #define PUT_TDD_MARKMS do { \
220         int x; \
221         for (x=0;x<8;x++) \
222                 PUT_AUDIO_SAMPLE(tdd_getcarrier(&cr, &ci, 1)); \
223 } while(0)
224
225 #define PUT_TDD_BAUD(bit) do { \
226         while(scont < tddsb) { \
227                 PUT_AUDIO_SAMPLE(tdd_getcarrier(&cr, &ci, bit)); \
228                 scont += 1.0; \
229         } \
230         scont -= tddsb; \
231 } while(0)
232
233 #define PUT_TDD_STOP do { \
234         while(scont < (tddsb * 1.5)) { \
235                 PUT_AUDIO_SAMPLE(tdd_getcarrier(&cr, &ci, 1)); \
236                 scont += 1.0; \
237         } \
238         scont -= (tddsb * 1.5); \
239 } while(0)
240
241
242 #define PUT_TDD(byte) do { \
243         int z; \
244         unsigned char b = (byte); \
245         PUT_TDD_BAUD(0);        /* Start bit */ \
246         for (z=0;z<5;z++) { \
247                 PUT_TDD_BAUD(b & 1); \
248                 b >>= 1; \
249         } \
250         PUT_TDD_STOP;   /* Stop bit */ \
251 } while(0);     
252
253 int tdd_generate(struct tdd_state *tdd, unsigned char *buf, const char *str)
254 {
255         int bytes=0;
256         int i,x;
257         char    c;
258         static unsigned char lstr[31] = "\000E\nA SIU\rDRJNFCKTZLWHYPQOBG\000MXV";
259         static unsigned char fstr[31] = "\0003\n- \00787\r$4',!:(5\")2\0006019?&\000./;";
260         /* Initial carriers (real/imaginary) */
261         float cr = 1.0;
262         float ci = 0.0;
263         float scont = 0.0;
264
265         for(x = 0; str[x]; x++) {
266                 c = toupper(str[x]);
267 #if     0
268                 printf("%c",c); fflush(stdout);
269 #endif
270                 if (c == 0) /* send null */
271                    {
272                         PUT_TDD(0);
273                         continue;
274                    }
275                 if (c == '\r') /* send c/r */
276                    {
277                         PUT_TDD(8);
278                         continue;
279                    }
280                 if (c == '\n') /* send c/r and l/f */
281                    {
282                         PUT_TDD(8);
283                         PUT_TDD(2);
284                         continue;
285                    }
286                 if (c == ' ') /* send space */
287                    {
288                         PUT_TDD(4);
289                         continue;
290                    }
291                 for(i = 0; i < 31; i++)
292                    {
293                         if (lstr[i] == c) break;
294                    }
295                 if (i < 31) /* if we found it */
296                    {
297                         if (tdd->mode)  /* if in figs mode, change it */
298                            { 
299                                 PUT_TDD(31); /* Send LTRS */
300                                 tdd->mode = 0;
301                            }
302                         PUT_TDD(i);
303                         continue;
304                    }
305                 for(i = 0; i < 31; i++)
306                    {
307                         if (fstr[i] == c) break;
308                    }
309                 if (i < 31) /* if we found it */
310                    {
311                         if (tdd->mode != 1)  /* if in ltrs mode, change it */
312                            {
313                                 PUT_TDD(27); /* send FIGS */
314                                 tdd->mode = 1;
315                            }
316                         PUT_TDD(i);  /* send byte */
317                         continue;
318                    }
319            }
320         return bytes;
321 }
322
323