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