Asterisk - The Open Source Telephony Project  18.5.0
gsm_encode.c
Go to the documentation of this file.
1 /*
2  * Copyright 1992 by Jutta Degener and Carsten Bormann, Technische
3  * Universitaet Berlin. See the accompanying file "COPYRIGHT" for
4  * details. THERE IS ABSOLUTELY NO WARRANTY FOR THIS SOFTWARE.
5  */
6 
7 /* $Header$ */
8 
9 #include "private.h"
10 #include "gsm.h"
11 #include "proto.h"
12 
13 void gsm_encode P3((s, source, c), gsm s, gsm_signal * source, gsm_byte * c)
14 {
15  word LARc[8], Nc[4], Mc[4], bc[4], xmaxc[4], xmc[13*4];
16 
17  Gsm_Coder(s, source, LARc, Nc, bc, Mc, xmaxc, xmc);
18 
19 
20  /* variable size
21 
22  GSM_MAGIC 4
23 
24  LARc[0] 6
25  LARc[1] 6
26  LARc[2] 5
27  LARc[3] 5
28  LARc[4] 4
29  LARc[5] 4
30  LARc[6] 3
31  LARc[7] 3
32 
33  Nc[0] 7
34  bc[0] 2
35  Mc[0] 2
36  xmaxc[0] 6
37  xmc[0] 3
38  xmc[1] 3
39  xmc[2] 3
40  xmc[3] 3
41  xmc[4] 3
42  xmc[5] 3
43  xmc[6] 3
44  xmc[7] 3
45  xmc[8] 3
46  xmc[9] 3
47  xmc[10] 3
48  xmc[11] 3
49  xmc[12] 3
50 
51  Nc[1] 7
52  bc[1] 2
53  Mc[1] 2
54  xmaxc[1] 6
55  xmc[13] 3
56  xmc[14] 3
57  xmc[15] 3
58  xmc[16] 3
59  xmc[17] 3
60  xmc[18] 3
61  xmc[19] 3
62  xmc[20] 3
63  xmc[21] 3
64  xmc[22] 3
65  xmc[23] 3
66  xmc[24] 3
67  xmc[25] 3
68 
69  Nc[2] 7
70  bc[2] 2
71  Mc[2] 2
72  xmaxc[2] 6
73  xmc[26] 3
74  xmc[27] 3
75  xmc[28] 3
76  xmc[29] 3
77  xmc[30] 3
78  xmc[31] 3
79  xmc[32] 3
80  xmc[33] 3
81  xmc[34] 3
82  xmc[35] 3
83  xmc[36] 3
84  xmc[37] 3
85  xmc[38] 3
86 
87  Nc[3] 7
88  bc[3] 2
89  Mc[3] 2
90  xmaxc[3] 6
91  xmc[39] 3
92  xmc[40] 3
93  xmc[41] 3
94  xmc[42] 3
95  xmc[43] 3
96  xmc[44] 3
97  xmc[45] 3
98  xmc[46] 3
99  xmc[47] 3
100  xmc[48] 3
101  xmc[49] 3
102  xmc[50] 3
103  xmc[51] 3
104  */
105 
106 #ifdef WAV49
107 
108  if (s->wav_fmt) {
109  s->frame_index = !s->frame_index;
110  if (s->frame_index) {
111 
112  uword sr;
113 
114  sr = 0;
115  sr = sr >> 6 | LARc[0] << 10;
116  sr = sr >> 6 | LARc[1] << 10;
117  *c++ = sr >> 4;
118  sr = sr >> 5 | LARc[2] << 11;
119  *c++ = sr >> 7;
120  sr = sr >> 5 | LARc[3] << 11;
121  sr = sr >> 4 | LARc[4] << 12;
122  *c++ = sr >> 6;
123  sr = sr >> 4 | LARc[5] << 12;
124  sr = sr >> 3 | LARc[6] << 13;
125  *c++ = sr >> 7;
126  sr = sr >> 3 | LARc[7] << 13;
127  sr = sr >> 7 | Nc[0] << 9;
128  *c++ = sr >> 5;
129  sr = sr >> 2 | bc[0] << 14;
130  sr = sr >> 2 | Mc[0] << 14;
131  sr = sr >> 6 | xmaxc[0] << 10;
132  *c++ = sr >> 3;
133  sr = sr >> 3 | xmc[0] << 13;
134  *c++ = sr >> 8;
135  sr = sr >> 3 | xmc[1] << 13;
136  sr = sr >> 3 | xmc[2] << 13;
137  sr = sr >> 3 | xmc[3] << 13;
138  *c++ = sr >> 7;
139  sr = sr >> 3 | xmc[4] << 13;
140  sr = sr >> 3 | xmc[5] << 13;
141  sr = sr >> 3 | xmc[6] << 13;
142  *c++ = sr >> 6;
143  sr = sr >> 3 | xmc[7] << 13;
144  sr = sr >> 3 | xmc[8] << 13;
145  *c++ = sr >> 8;
146  sr = sr >> 3 | xmc[9] << 13;
147  sr = sr >> 3 | xmc[10] << 13;
148  sr = sr >> 3 | xmc[11] << 13;
149  *c++ = sr >> 7;
150  sr = sr >> 3 | xmc[12] << 13;
151  sr = sr >> 7 | Nc[1] << 9;
152  *c++ = sr >> 5;
153  sr = sr >> 2 | bc[1] << 14;
154  sr = sr >> 2 | Mc[1] << 14;
155  sr = sr >> 6 | xmaxc[1] << 10;
156  *c++ = sr >> 3;
157  sr = sr >> 3 | xmc[13] << 13;
158  *c++ = sr >> 8;
159  sr = sr >> 3 | xmc[14] << 13;
160  sr = sr >> 3 | xmc[15] << 13;
161  sr = sr >> 3 | xmc[16] << 13;
162  *c++ = sr >> 7;
163  sr = sr >> 3 | xmc[17] << 13;
164  sr = sr >> 3 | xmc[18] << 13;
165  sr = sr >> 3 | xmc[19] << 13;
166  *c++ = sr >> 6;
167  sr = sr >> 3 | xmc[20] << 13;
168  sr = sr >> 3 | xmc[21] << 13;
169  *c++ = sr >> 8;
170  sr = sr >> 3 | xmc[22] << 13;
171  sr = sr >> 3 | xmc[23] << 13;
172  sr = sr >> 3 | xmc[24] << 13;
173  *c++ = sr >> 7;
174  sr = sr >> 3 | xmc[25] << 13;
175  sr = sr >> 7 | Nc[2] << 9;
176  *c++ = sr >> 5;
177  sr = sr >> 2 | bc[2] << 14;
178  sr = sr >> 2 | Mc[2] << 14;
179  sr = sr >> 6 | xmaxc[2] << 10;
180  *c++ = sr >> 3;
181  sr = sr >> 3 | xmc[26] << 13;
182  *c++ = sr >> 8;
183  sr = sr >> 3 | xmc[27] << 13;
184  sr = sr >> 3 | xmc[28] << 13;
185  sr = sr >> 3 | xmc[29] << 13;
186  *c++ = sr >> 7;
187  sr = sr >> 3 | xmc[30] << 13;
188  sr = sr >> 3 | xmc[31] << 13;
189  sr = sr >> 3 | xmc[32] << 13;
190  *c++ = sr >> 6;
191  sr = sr >> 3 | xmc[33] << 13;
192  sr = sr >> 3 | xmc[34] << 13;
193  *c++ = sr >> 8;
194  sr = sr >> 3 | xmc[35] << 13;
195  sr = sr >> 3 | xmc[36] << 13;
196  sr = sr >> 3 | xmc[37] << 13;
197  *c++ = sr >> 7;
198  sr = sr >> 3 | xmc[38] << 13;
199  sr = sr >> 7 | Nc[3] << 9;
200  *c++ = sr >> 5;
201  sr = sr >> 2 | bc[3] << 14;
202  sr = sr >> 2 | Mc[3] << 14;
203  sr = sr >> 6 | xmaxc[3] << 10;
204  *c++ = sr >> 3;
205  sr = sr >> 3 | xmc[39] << 13;
206  *c++ = sr >> 8;
207  sr = sr >> 3 | xmc[40] << 13;
208  sr = sr >> 3 | xmc[41] << 13;
209  sr = sr >> 3 | xmc[42] << 13;
210  *c++ = sr >> 7;
211  sr = sr >> 3 | xmc[43] << 13;
212  sr = sr >> 3 | xmc[44] << 13;
213  sr = sr >> 3 | xmc[45] << 13;
214  *c++ = sr >> 6;
215  sr = sr >> 3 | xmc[46] << 13;
216  sr = sr >> 3 | xmc[47] << 13;
217  *c++ = sr >> 8;
218  sr = sr >> 3 | xmc[48] << 13;
219  sr = sr >> 3 | xmc[49] << 13;
220  sr = sr >> 3 | xmc[50] << 13;
221  *c++ = sr >> 7;
222  sr = sr >> 3 | xmc[51] << 13;
223  sr = sr >> 4;
224  *c = sr >> 8;
225  s->frame_chain = *c;
226  }
227  else {
228  uword sr;
229 
230  sr = 0;
231  sr = sr >> 4 | s->frame_chain << 12;
232  sr = sr >> 6 | LARc[0] << 10;
233  *c++ = sr >> 6;
234  sr = sr >> 6 | LARc[1] << 10;
235  *c++ = sr >> 8;
236  sr = sr >> 5 | LARc[2] << 11;
237  sr = sr >> 5 | LARc[3] << 11;
238  *c++ = sr >> 6;
239  sr = sr >> 4 | LARc[4] << 12;
240  sr = sr >> 4 | LARc[5] << 12;
241  *c++ = sr >> 6;
242  sr = sr >> 3 | LARc[6] << 13;
243  sr = sr >> 3 | LARc[7] << 13;
244  *c++ = sr >> 8;
245  sr = sr >> 7 | Nc[0] << 9;
246  sr = sr >> 2 | bc[0] << 14;
247  *c++ = sr >> 7;
248  sr = sr >> 2 | Mc[0] << 14;
249  sr = sr >> 6 | xmaxc[0] << 10;
250  *c++ = sr >> 7;
251  sr = sr >> 3 | xmc[0] << 13;
252  sr = sr >> 3 | xmc[1] << 13;
253  sr = sr >> 3 | xmc[2] << 13;
254  *c++ = sr >> 6;
255  sr = sr >> 3 | xmc[3] << 13;
256  sr = sr >> 3 | xmc[4] << 13;
257  *c++ = sr >> 8;
258  sr = sr >> 3 | xmc[5] << 13;
259  sr = sr >> 3 | xmc[6] << 13;
260  sr = sr >> 3 | xmc[7] << 13;
261  *c++ = sr >> 7;
262  sr = sr >> 3 | xmc[8] << 13;
263  sr = sr >> 3 | xmc[9] << 13;
264  sr = sr >> 3 | xmc[10] << 13;
265  *c++ = sr >> 6;
266  sr = sr >> 3 | xmc[11] << 13;
267  sr = sr >> 3 | xmc[12] << 13;
268  *c++ = sr >> 8;
269  sr = sr >> 7 | Nc[1] << 9;
270  sr = sr >> 2 | bc[1] << 14;
271  *c++ = sr >> 7;
272  sr = sr >> 2 | Mc[1] << 14;
273  sr = sr >> 6 | xmaxc[1] << 10;
274  *c++ = sr >> 7;
275  sr = sr >> 3 | xmc[13] << 13;
276  sr = sr >> 3 | xmc[14] << 13;
277  sr = sr >> 3 | xmc[15] << 13;
278  *c++ = sr >> 6;
279  sr = sr >> 3 | xmc[16] << 13;
280  sr = sr >> 3 | xmc[17] << 13;
281  *c++ = sr >> 8;
282  sr = sr >> 3 | xmc[18] << 13;
283  sr = sr >> 3 | xmc[19] << 13;
284  sr = sr >> 3 | xmc[20] << 13;
285  *c++ = sr >> 7;
286  sr = sr >> 3 | xmc[21] << 13;
287  sr = sr >> 3 | xmc[22] << 13;
288  sr = sr >> 3 | xmc[23] << 13;
289  *c++ = sr >> 6;
290  sr = sr >> 3 | xmc[24] << 13;
291  sr = sr >> 3 | xmc[25] << 13;
292  *c++ = sr >> 8;
293  sr = sr >> 7 | Nc[2] << 9;
294  sr = sr >> 2 | bc[2] << 14;
295  *c++ = sr >> 7;
296  sr = sr >> 2 | Mc[2] << 14;
297  sr = sr >> 6 | xmaxc[2] << 10;
298  *c++ = sr >> 7;
299  sr = sr >> 3 | xmc[26] << 13;
300  sr = sr >> 3 | xmc[27] << 13;
301  sr = sr >> 3 | xmc[28] << 13;
302  *c++ = sr >> 6;
303  sr = sr >> 3 | xmc[29] << 13;
304  sr = sr >> 3 | xmc[30] << 13;
305  *c++ = sr >> 8;
306  sr = sr >> 3 | xmc[31] << 13;
307  sr = sr >> 3 | xmc[32] << 13;
308  sr = sr >> 3 | xmc[33] << 13;
309  *c++ = sr >> 7;
310  sr = sr >> 3 | xmc[34] << 13;
311  sr = sr >> 3 | xmc[35] << 13;
312  sr = sr >> 3 | xmc[36] << 13;
313  *c++ = sr >> 6;
314  sr = sr >> 3 | xmc[37] << 13;
315  sr = sr >> 3 | xmc[38] << 13;
316  *c++ = sr >> 8;
317  sr = sr >> 7 | Nc[3] << 9;
318  sr = sr >> 2 | bc[3] << 14;
319  *c++ = sr >> 7;
320  sr = sr >> 2 | Mc[3] << 14;
321  sr = sr >> 6 | xmaxc[3] << 10;
322  *c++ = sr >> 7;
323  sr = sr >> 3 | xmc[39] << 13;
324  sr = sr >> 3 | xmc[40] << 13;
325  sr = sr >> 3 | xmc[41] << 13;
326  *c++ = sr >> 6;
327  sr = sr >> 3 | xmc[42] << 13;
328  sr = sr >> 3 | xmc[43] << 13;
329  *c++ = sr >> 8;
330  sr = sr >> 3 | xmc[44] << 13;
331  sr = sr >> 3 | xmc[45] << 13;
332  sr = sr >> 3 | xmc[46] << 13;
333  *c++ = sr >> 7;
334  sr = sr >> 3 | xmc[47] << 13;
335  sr = sr >> 3 | xmc[48] << 13;
336  sr = sr >> 3 | xmc[49] << 13;
337  *c++ = sr >> 6;
338  sr = sr >> 3 | xmc[50] << 13;
339  sr = sr >> 3 | xmc[51] << 13;
340  *c++ = sr >> 8;
341  }
342  }
343 
344  else
345 
346 #endif /* WAV49 */
347  {
348 
349  *c++ = ((GSM_MAGIC & 0xF) << 4) /* 1 */
350  | ((LARc[0] >> 2) & 0xF);
351  *c++ = ((LARc[0] & 0x3) << 6)
352  | (LARc[1] & 0x3F);
353  *c++ = ((LARc[2] & 0x1F) << 3)
354  | ((LARc[3] >> 2) & 0x7);
355  *c++ = ((LARc[3] & 0x3) << 6)
356  | ((LARc[4] & 0xF) << 2)
357  | ((LARc[5] >> 2) & 0x3);
358  *c++ = ((LARc[5] & 0x3) << 6)
359  | ((LARc[6] & 0x7) << 3)
360  | (LARc[7] & 0x7);
361  *c++ = ((Nc[0] & 0x7F) << 1)
362  | ((bc[0] >> 1) & 0x1);
363  *c++ = ((bc[0] & 0x1) << 7)
364  | ((Mc[0] & 0x3) << 5)
365  | ((xmaxc[0] >> 1) & 0x1F);
366  *c++ = ((xmaxc[0] & 0x1) << 7)
367  | ((xmc[0] & 0x7) << 4)
368  | ((xmc[1] & 0x7) << 1)
369  | ((xmc[2] >> 2) & 0x1);
370  *c++ = ((xmc[2] & 0x3) << 6)
371  | ((xmc[3] & 0x7) << 3)
372  | (xmc[4] & 0x7);
373  *c++ = ((xmc[5] & 0x7) << 5) /* 10 */
374  | ((xmc[6] & 0x7) << 2)
375  | ((xmc[7] >> 1) & 0x3);
376  *c++ = ((xmc[7] & 0x1) << 7)
377  | ((xmc[8] & 0x7) << 4)
378  | ((xmc[9] & 0x7) << 1)
379  | ((xmc[10] >> 2) & 0x1);
380  *c++ = ((xmc[10] & 0x3) << 6)
381  | ((xmc[11] & 0x7) << 3)
382  | (xmc[12] & 0x7);
383  *c++ = ((Nc[1] & 0x7F) << 1)
384  | ((bc[1] >> 1) & 0x1);
385  *c++ = ((bc[1] & 0x1) << 7)
386  | ((Mc[1] & 0x3) << 5)
387  | ((xmaxc[1] >> 1) & 0x1F);
388  *c++ = ((xmaxc[1] & 0x1) << 7)
389  | ((xmc[13] & 0x7) << 4)
390  | ((xmc[14] & 0x7) << 1)
391  | ((xmc[15] >> 2) & 0x1);
392  *c++ = ((xmc[15] & 0x3) << 6)
393  | ((xmc[16] & 0x7) << 3)
394  | (xmc[17] & 0x7);
395  *c++ = ((xmc[18] & 0x7) << 5)
396  | ((xmc[19] & 0x7) << 2)
397  | ((xmc[20] >> 1) & 0x3);
398  *c++ = ((xmc[20] & 0x1) << 7)
399  | ((xmc[21] & 0x7) << 4)
400  | ((xmc[22] & 0x7) << 1)
401  | ((xmc[23] >> 2) & 0x1);
402  *c++ = ((xmc[23] & 0x3) << 6)
403  | ((xmc[24] & 0x7) << 3)
404  | (xmc[25] & 0x7);
405  *c++ = ((Nc[2] & 0x7F) << 1) /* 20 */
406  | ((bc[2] >> 1) & 0x1);
407  *c++ = ((bc[2] & 0x1) << 7)
408  | ((Mc[2] & 0x3) << 5)
409  | ((xmaxc[2] >> 1) & 0x1F);
410  *c++ = ((xmaxc[2] & 0x1) << 7)
411  | ((xmc[26] & 0x7) << 4)
412  | ((xmc[27] & 0x7) << 1)
413  | ((xmc[28] >> 2) & 0x1);
414  *c++ = ((xmc[28] & 0x3) << 6)
415  | ((xmc[29] & 0x7) << 3)
416  | (xmc[30] & 0x7);
417  *c++ = ((xmc[31] & 0x7) << 5)
418  | ((xmc[32] & 0x7) << 2)
419  | ((xmc[33] >> 1) & 0x3);
420  *c++ = ((xmc[33] & 0x1) << 7)
421  | ((xmc[34] & 0x7) << 4)
422  | ((xmc[35] & 0x7) << 1)
423  | ((xmc[36] >> 2) & 0x1);
424  *c++ = ((xmc[36] & 0x3) << 6)
425  | ((xmc[37] & 0x7) << 3)
426  | (xmc[38] & 0x7);
427  *c++ = ((Nc[3] & 0x7F) << 1)
428  | ((bc[3] >> 1) & 0x1);
429  *c++ = ((bc[3] & 0x1) << 7)
430  | ((Mc[3] & 0x3) << 5)
431  | ((xmaxc[3] >> 1) & 0x1F);
432  *c++ = ((xmaxc[3] & 0x1) << 7)
433  | ((xmc[39] & 0x7) << 4)
434  | ((xmc[40] & 0x7) << 1)
435  | ((xmc[41] >> 2) & 0x1);
436  *c++ = ((xmc[41] & 0x3) << 6) /* 30 */
437  | ((xmc[42] & 0x7) << 3)
438  | (xmc[43] & 0x7);
439  *c++ = ((xmc[44] & 0x7) << 5)
440  | ((xmc[45] & 0x7) << 2)
441  | ((xmc[46] >> 1) & 0x3);
442  *c++ = ((xmc[46] & 0x1) << 7)
443  | ((xmc[47] & 0x7) << 4)
444  | ((xmc[48] & 0x7) << 1)
445  | ((xmc[49] >> 2) & 0x1);
446  *c++ = ((xmc[49] & 0x3) << 6)
447  | ((xmc[50] & 0x7) << 3)
448  | (xmc[51] & 0x7);
449 
450  }
451 }
gsm_state::frame_index
unsigned char frame_index
Definition: codecs/gsm/inc/private.h:39
bc
#define bc
Mc
#define Mc
xmc
#define xmc
gsm_byte
unsigned char gsm_byte
Definition: gsm.h:41
c
static struct test_val c
Definition: test_linkedlists.c:48
GSM_MAGIC
#define GSM_MAGIC
Definition: gsm.h:44
uword
unsigned short uword
Definition: codecs/gsm/inc/private.h:15
gsm_signal
short gsm_signal
Definition: gsm.h:40
P3
void gsm_encode P3((s, source, c), gsm s, gsm_signal *source, gsm_byte *c)
Definition: gsm_encode.c:13
xmaxc
#define xmaxc
gsm_state::wav_fmt
char wav_fmt
Definition: codecs/gsm/inc/private.h:38
gsm_state::frame_chain
unsigned char frame_chain
Definition: codecs/gsm/inc/private.h:40
Nc
#define Nc
gsm_state
Definition: codecs/gsm/inc/private.h:18
LARc
#define LARc
word
short word
Definition: codecs/gsm/inc/private.h:12
Generated on Sun Aug 8 2021 19:43:47 for Asterisk - The Open Source Telephony Project by   doxygen 1.8.13