Asterisk - The Open Source Telephony Project  18.5.0
gsm_implode.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 
11 #include "gsm.h"
12 #include "proto.h"
13 
14 void gsm_implode P3((s, source, c), gsm s, gsm_signal * source, gsm_byte * c)
15 {
16  /* variable size index
17 
18  GSM_MAGIC 4 -
19 
20  LARc[0] 6 0
21  LARc[1] 6 1
22  LARc[2] 5 2
23  LARc[3] 5 3
24  LARc[4] 4 4
25  LARc[5] 4 5
26  LARc[6] 3 6
27  LARc[7] 3 7
28 
29  Nc[0] 7 8
30  bc[0] 2 9
31  Mc[0] 2 10
32  xmaxc[0] 6 11
33  xmc[0] 3 12
34  xmc[1] 3 13
35  xmc[2] 3 14
36  xmc[3] 3 15
37  xmc[4] 3 16
38  xmc[5] 3 17
39  xmc[6] 3 18
40  xmc[7] 3 19
41  xmc[8] 3 20
42  xmc[9] 3 21
43  xmc[10] 3 22
44  xmc[11] 3 23
45  xmc[12] 3 24
46 
47  Nc[1] 7 25
48  bc[1] 2 26
49  Mc[1] 2 27
50  xmaxc[1] 6 28
51  xmc[13] 3 29
52  xmc[14] 3 30
53  xmc[15] 3 31
54  xmc[16] 3 32
55  xmc[17] 3 33
56  xmc[18] 3 34
57  xmc[19] 3 35
58  xmc[20] 3 36
59  xmc[21] 3 37
60  xmc[22] 3 38
61  xmc[23] 3 39
62  xmc[24] 3 40
63  xmc[25] 3 41
64 
65  Nc[2] 7 42
66  bc[2] 2 43
67  Mc[2] 2 44
68  xmaxc[2] 6 45
69  xmc[26] 3 46
70  xmc[27] 3 47
71  xmc[28] 3 48
72  xmc[29] 3 49
73  xmc[30] 3 50
74  xmc[31] 3 51
75  xmc[32] 3 52
76  xmc[33] 3 53
77  xmc[34] 3 54
78  xmc[35] 3 55
79  xmc[36] 3 56
80  xmc[37] 3 57
81  xmc[38] 3 58
82 
83  Nc[3] 7 59
84  bc[3] 2 60
85  Mc[3] 2 61
86  xmaxc[3] 6 62
87  xmc[39] 3 63
88  xmc[40] 3 64
89  xmc[41] 3 65
90  xmc[42] 3 66
91  xmc[43] 3 67
92  xmc[44] 3 68
93  xmc[45] 3 69
94  xmc[46] 3 70
95  xmc[47] 3 71
96  xmc[48] 3 72
97  xmc[49] 3 73
98  xmc[50] 3 74
99  xmc[51] 3 75
100  */
101 
102  /* There are 76 parameters per frame. The first eight are
103  * unique. The remaining 68 are four identical subframes of
104  * 17 parameters each. gsm_implode converts from a representation
105  * of these parameters as values in one array of signed words
106  * to the "packed" version of a GSM frame.
107  */
108 
109 # define LARc source
110 # define Nc *((gsm_signal (*) [17])(source + 8))
111 # define bc *((gsm_signal (*) [17])(source + 9))
112 # define Mc *((gsm_signal (*) [17])(source + 10))
113 # define xmaxc *((gsm_signal (*) [17])(source + 11))
114 
115 #ifdef WAV49
116  if (s->wav_fmt) {
117 
118  uword sr = 0;
119  if (s->frame_index == 0) {
120 
121  sr = *c++;
122  LARc[0] = sr & 0x3f; sr >>= 6;
123  sr |= (uword)*c++ << 2;
124  LARc[1] = sr & 0x3f; sr >>= 6;
125  sr |= (uword)*c++ << 4;
126  LARc[2] = sr & 0x1f; sr >>= 5;
127  LARc[3] = sr & 0x1f; sr >>= 5;
128  sr |= (uword)*c++ << 2;
129  LARc[4] = sr & 0xf; sr >>= 4;
130  LARc[5] = sr & 0xf; sr >>= 4;
131  sr |= (uword)*c++ << 2; /* 5 */
132  LARc[6] = sr & 0x7; sr >>= 3;
133  LARc[7] = sr & 0x7; sr >>= 3;
134  sr |= (uword)*c++ << 4;
135  Nc[0] = sr & 0x7f; sr >>= 7;
136  bc[0] = sr & 0x3; sr >>= 2;
137  Mc[0] = sr & 0x3; sr >>= 2;
138  sr |= (uword)*c++ << 1;
139  xmaxc[0] = sr & 0x3f; sr >>= 6;
140 #undef xmc
141 #define xmc (source + 12)
142  xmc[0] = sr & 0x7; sr >>= 3;
143  sr = *c++;
144  xmc[1] = sr & 0x7; sr >>= 3;
145  xmc[2] = sr & 0x7; sr >>= 3;
146  sr |= (uword)*c++ << 2;
147  xmc[3] = sr & 0x7; sr >>= 3;
148  xmc[4] = sr & 0x7; sr >>= 3;
149  xmc[5] = sr & 0x7; sr >>= 3;
150  sr |= (uword)*c++ << 1; /* 10 */
151  xmc[6] = sr & 0x7; sr >>= 3;
152  xmc[7] = sr & 0x7; sr >>= 3;
153  xmc[8] = sr & 0x7; sr >>= 3;
154  sr = *c++;
155  xmc[9] = sr & 0x7; sr >>= 3;
156  xmc[10] = sr & 0x7; sr >>= 3;
157  sr |= (uword)*c++ << 2;
158  xmc[11] = sr & 0x7; sr >>= 3;
159  xmc[12] = sr & 0x7; sr >>= 3;
160  sr |= (uword)*c++ << 4;
161  Nc[1] = sr & 0x7f; sr >>= 7;
162  bc[1] = sr & 0x3; sr >>= 2;
163  Mc[1] = sr & 0x3; sr >>= 2;
164  sr |= (uword)*c++ << 1;
165  xmaxc[1] = sr & 0x3f; sr >>= 6;
166 #undef xmc
167 #define xmc (source + 29 - 13)
168  xmc[13] = sr & 0x7; sr >>= 3;
169  sr = *c++; /* 15 */
170  xmc[14] = sr & 0x7; sr >>= 3;
171  xmc[15] = sr & 0x7; sr >>= 3;
172  sr |= (uword)*c++ << 2;
173  xmc[16] = sr & 0x7; sr >>= 3;
174  xmc[17] = sr & 0x7; sr >>= 3;
175  xmc[18] = sr & 0x7; sr >>= 3;
176  sr |= (uword)*c++ << 1;
177  xmc[19] = sr & 0x7; sr >>= 3;
178  xmc[20] = sr & 0x7; sr >>= 3;
179  xmc[21] = sr & 0x7; sr >>= 3;
180  sr = *c++;
181  xmc[22] = sr & 0x7; sr >>= 3;
182  xmc[23] = sr & 0x7; sr >>= 3;
183  sr |= (uword)*c++ << 2;
184  xmc[24] = sr & 0x7; sr >>= 3;
185  xmc[25] = sr & 0x7; sr >>= 3;
186  sr |= (uword)*c++ << 4; /* 20 */
187  Nc[2] = sr & 0x7f; sr >>= 7;
188  bc[2] = sr & 0x3; sr >>= 2;
189  Mc[2] = sr & 0x3; sr >>= 2;
190  sr |= (uword)*c++ << 1;
191  xmaxc[2] = sr & 0x3f; sr >>= 6;
192 #undef xmc
193 #define xmc (source + 46 - 26)
194  xmc[26] = sr & 0x7; sr >>= 3;
195  sr = *c++;
196  xmc[27] = sr & 0x7; sr >>= 3;
197  xmc[28] = sr & 0x7; sr >>= 3;
198  sr |= (uword)*c++ << 2;
199  xmc[29] = sr & 0x7; sr >>= 3;
200  xmc[30] = sr & 0x7; sr >>= 3;
201  xmc[31] = sr & 0x7; sr >>= 3;
202  sr |= (uword)*c++ << 1;
203  xmc[32] = sr & 0x7; sr >>= 3;
204  xmc[33] = sr & 0x7; sr >>= 3;
205  xmc[34] = sr & 0x7; sr >>= 3;
206  sr = *c++; /* 25 */
207  xmc[35] = sr & 0x7; sr >>= 3;
208  xmc[36] = sr & 0x7; sr >>= 3;
209  sr |= (uword)*c++ << 2;
210  xmc[37] = sr & 0x7; sr >>= 3;
211  xmc[38] = sr & 0x7; sr >>= 3;
212  sr |= (uword)*c++ << 4;
213  Nc[3] = sr & 0x7f; sr >>= 7;
214  bc[3] = sr & 0x3; sr >>= 2;
215  Mc[3] = sr & 0x3; sr >>= 2;
216  sr |= (uword)*c++ << 1;
217  xmaxc[3] = sr & 0x3f; sr >>= 6;
218 #undef xmc
219 #define xmc (source + 63 - 39)
220 
221  xmc[39] = sr & 0x7; sr >>= 3;
222  sr = *c++;
223  xmc[40] = sr & 0x7; sr >>= 3;
224  xmc[41] = sr & 0x7; sr >>= 3;
225  sr |= (uword)*c++ << 2; /* 30 */
226  xmc[42] = sr & 0x7; sr >>= 3;
227  xmc[43] = sr & 0x7; sr >>= 3;
228  xmc[44] = sr & 0x7; sr >>= 3;
229  sr |= (uword)*c++ << 1;
230  xmc[45] = sr & 0x7; sr >>= 3;
231  xmc[46] = sr & 0x7; sr >>= 3;
232  xmc[47] = sr & 0x7; sr >>= 3;
233  sr = *c++;
234  xmc[48] = sr & 0x7; sr >>= 3;
235  xmc[49] = sr & 0x7; sr >>= 3;
236  sr |= (uword)*c++ << 2;
237  xmc[50] = sr & 0x7; sr >>= 3;
238  xmc[51] = sr & 0x7; sr >>= 3;
239 
240  s->frame_chain = sr & 0xf;
241  }
242  else {
243  sr = s->frame_chain;
244  sr |= (uword)*c++ << 4; /* 1 */
245  LARc[0] = sr & 0x3f; sr >>= 6;
246  LARc[1] = sr & 0x3f; sr >>= 6;
247  sr = *c++;
248  LARc[2] = sr & 0x1f; sr >>= 5;
249  sr |= (uword)*c++ << 3;
250  LARc[3] = sr & 0x1f; sr >>= 5;
251  LARc[4] = sr & 0xf; sr >>= 4;
252  sr |= (uword)*c++ << 2;
253  LARc[5] = sr & 0xf; sr >>= 4;
254  LARc[6] = sr & 0x7; sr >>= 3;
255  LARc[7] = sr & 0x7; sr >>= 3;
256  sr = *c++; /* 5 */
257  Nc[0] = sr & 0x7f; sr >>= 7;
258  sr |= (uword)*c++ << 1;
259  bc[0] = sr & 0x3; sr >>= 2;
260  Mc[0] = sr & 0x3; sr >>= 2;
261  sr |= (uword)*c++ << 5;
262  xmaxc[0] = sr & 0x3f; sr >>= 6;
263 #undef xmc
264 #define xmc (source + 12)
265  xmc[0] = sr & 0x7; sr >>= 3;
266  xmc[1] = sr & 0x7; sr >>= 3;
267  sr |= (uword)*c++ << 1;
268  xmc[2] = sr & 0x7; sr >>= 3;
269  xmc[3] = sr & 0x7; sr >>= 3;
270  xmc[4] = sr & 0x7; sr >>= 3;
271  sr = *c++;
272  xmc[5] = sr & 0x7; sr >>= 3;
273  xmc[6] = sr & 0x7; sr >>= 3;
274  sr |= (uword)*c++ << 2; /* 10 */
275  xmc[7] = sr & 0x7; sr >>= 3;
276  xmc[8] = sr & 0x7; sr >>= 3;
277  xmc[9] = sr & 0x7; sr >>= 3;
278  sr |= (uword)*c++ << 1;
279  xmc[10] = sr & 0x7; sr >>= 3;
280  xmc[11] = sr & 0x7; sr >>= 3;
281  xmc[12] = sr & 0x7; sr >>= 3;
282  sr = *c++;
283  Nc[1] = sr & 0x7f; sr >>= 7;
284  sr |= (uword)*c++ << 1;
285  bc[1] = sr & 0x3; sr >>= 2;
286  Mc[1] = sr & 0x3; sr >>= 2;
287  sr |= (uword)*c++ << 5;
288  xmaxc[1] = sr & 0x3f; sr >>= 6;
289 #undef xmc
290 #define xmc (source + 29 - 13)
291  xmc[13] = sr & 0x7; sr >>= 3;
292  xmc[14] = sr & 0x7; sr >>= 3;
293  sr |= (uword)*c++ << 1; /* 15 */
294  xmc[15] = sr & 0x7; sr >>= 3;
295  xmc[16] = sr & 0x7; sr >>= 3;
296  xmc[17] = sr & 0x7; sr >>= 3;
297  sr = *c++;
298  xmc[18] = sr & 0x7; sr >>= 3;
299  xmc[19] = sr & 0x7; sr >>= 3;
300  sr |= (uword)*c++ << 2;
301  xmc[20] = sr & 0x7; sr >>= 3;
302  xmc[21] = sr & 0x7; sr >>= 3;
303  xmc[22] = sr & 0x7; sr >>= 3;
304  sr |= (uword)*c++ << 1;
305  xmc[23] = sr & 0x7; sr >>= 3;
306  xmc[24] = sr & 0x7; sr >>= 3;
307  xmc[25] = sr & 0x7; sr >>= 3;
308  sr = *c++;
309  Nc[2] = sr & 0x7f; sr >>= 7;
310  sr |= (uword)*c++ << 1; /* 20 */
311  bc[2] = sr & 0x3; sr >>= 2;
312  Mc[2] = sr & 0x3; sr >>= 2;
313  sr |= (uword)*c++ << 5;
314  xmaxc[2] = sr & 0x3f; sr >>= 6;
315 #undef xmc
316 #define xmc (source + 46 - 26)
317  xmc[26] = sr & 0x7; sr >>= 3;
318  xmc[27] = sr & 0x7; sr >>= 3;
319  sr |= (uword)*c++ << 1;
320  xmc[28] = sr & 0x7; sr >>= 3;
321  xmc[29] = sr & 0x7; sr >>= 3;
322  xmc[30] = sr & 0x7; sr >>= 3;
323  sr = *c++;
324  xmc[31] = sr & 0x7; sr >>= 3;
325  xmc[32] = sr & 0x7; sr >>= 3;
326  sr |= (uword)*c++ << 2;
327  xmc[33] = sr & 0x7; sr >>= 3;
328  xmc[34] = sr & 0x7; sr >>= 3;
329  xmc[35] = sr & 0x7; sr >>= 3;
330  sr |= (uword)*c++ << 1; /* 25 */
331  xmc[36] = sr & 0x7; sr >>= 3;
332  xmc[37] = sr & 0x7; sr >>= 3;
333  xmc[38] = sr & 0x7; sr >>= 3;
334  sr = *c++;
335  Nc[3] = sr & 0x7f; sr >>= 7;
336  sr |= (uword)*c++ << 1;
337  bc[3] = sr & 0x3; sr >>= 2;
338  Mc[3] = sr & 0x3; sr >>= 2;
339  sr |= (uword)*c++ << 5;
340  xmaxc[3] = sr & 0x3f; sr >>= 6;
341 #undef xmc
342 #define xmc (source + 63 - 39)
343 
344  xmc[39] = sr & 0x7; sr >>= 3;
345  xmc[40] = sr & 0x7; sr >>= 3;
346  sr |= (uword)*c++ << 1;
347  xmc[41] = sr & 0x7; sr >>= 3;
348  xmc[42] = sr & 0x7; sr >>= 3;
349  xmc[43] = sr & 0x7; sr >>= 3;
350  sr = *c++; /* 30 */
351  xmc[44] = sr & 0x7; sr >>= 3;
352  xmc[45] = sr & 0x7; sr >>= 3;
353  sr |= (uword)*c++ << 2;
354  xmc[46] = sr & 0x7; sr >>= 3;
355  xmc[47] = sr & 0x7; sr >>= 3;
356  xmc[48] = sr & 0x7; sr >>= 3;
357  sr |= (uword)*c++ << 1;
358  xmc[49] = sr & 0x7; sr >>= 3;
359  xmc[50] = sr & 0x7; sr >>= 3;
360  xmc[51] = sr & 0x7; sr >>= 3;
361  }
362  }
363  else
364 #endif
365  {
366 
367  *c++ = ((GSM_MAGIC & 0xF) << 4) /* 1 */
368  | ((LARc[0] >> 2) & 0xF);
369  *c++ = ((LARc[0] & 0x3) << 6)
370  | (LARc[1] & 0x3F);
371  *c++ = ((LARc[2] & 0x1F) << 3)
372  | ((LARc[3] >> 2) & 0x7);
373  *c++ = ((LARc[3] & 0x3) << 6)
374  | ((LARc[4] & 0xF) << 2)
375  | ((LARc[5] >> 2) & 0x3);
376  *c++ = ((LARc[5] & 0x3) << 6)
377  | ((LARc[6] & 0x7) << 3)
378  | (LARc[7] & 0x7);
379 
380 
381  *c++ = ((Nc[0] & 0x7F) << 1)
382 
383 
384  | ((bc[0] >> 1) & 0x1);
385  *c++ = ((bc[0] & 0x1) << 7)
386 
387 
388  | ((Mc[0] & 0x3) << 5)
389 
390  | ((xmaxc[0] >> 1) & 0x1F);
391  *c++ = ((xmaxc[0] & 0x1) << 7)
392 
393 #undef xmc
394 #define xmc (source + 12)
395 
396  | ((xmc[0] & 0x7) << 4)
397  | ((xmc[1] & 0x7) << 1)
398  | ((xmc[2] >> 2) & 0x1);
399  *c++ = ((xmc[2] & 0x3) << 6)
400  | ((xmc[3] & 0x7) << 3)
401  | (xmc[4] & 0x7);
402  *c++ = ((xmc[5] & 0x7) << 5) /* 10 */
403  | ((xmc[6] & 0x7) << 2)
404  | ((xmc[7] >> 1) & 0x3);
405  *c++ = ((xmc[7] & 0x1) << 7)
406  | ((xmc[8] & 0x7) << 4)
407  | ((xmc[9] & 0x7) << 1)
408  | ((xmc[10] >> 2) & 0x1);
409  *c++ = ((xmc[10] & 0x3) << 6)
410  | ((xmc[11] & 0x7) << 3)
411  | (xmc[12] & 0x7);
412 
413 
414  *c++ = ((Nc[1] & 0x7F) << 1)
415 
416 
417  | ((bc[1] >> 1) & 0x1);
418  *c++ = ((bc[1] & 0x1) << 7)
419 
420 
421  | ((Mc[1] & 0x3) << 5)
422 
423 
424  | ((xmaxc[1] >> 1) & 0x1F);
425  *c++ = ((xmaxc[1] & 0x1) << 7)
426 
427 #undef xmc
428 #define xmc (source + 29 - 13)
429 
430  | ((xmc[13] & 0x7) << 4)
431  | ((xmc[14] & 0x7) << 1)
432  | ((xmc[15] >> 2) & 0x1);
433  *c++ = ((xmc[15] & 0x3) << 6)
434  | ((xmc[16] & 0x7) << 3)
435  | (xmc[17] & 0x7);
436  *c++ = ((xmc[18] & 0x7) << 5)
437  | ((xmc[19] & 0x7) << 2)
438  | ((xmc[20] >> 1) & 0x3);
439  *c++ = ((xmc[20] & 0x1) << 7)
440  | ((xmc[21] & 0x7) << 4)
441  | ((xmc[22] & 0x7) << 1)
442  | ((xmc[23] >> 2) & 0x1);
443  *c++ = ((xmc[23] & 0x3) << 6)
444  | ((xmc[24] & 0x7) << 3)
445  | (xmc[25] & 0x7);
446 
447 
448  *c++ = ((Nc[2] & 0x7F) << 1) /* 20 */
449 
450 
451  | ((bc[2] >> 1) & 0x1);
452  *c++ = ((bc[2] & 0x1) << 7)
453 
454 
455  | ((Mc[2] & 0x3) << 5)
456 
457 
458  | ((xmaxc[2] >> 1) & 0x1F);
459  *c++ = ((xmaxc[2] & 0x1) << 7)
460 
461 #undef xmc
462 #define xmc (source + 46 - 26)
463 
464  | ((xmc[26] & 0x7) << 4)
465  | ((xmc[27] & 0x7) << 1)
466  | ((xmc[28] >> 2) & 0x1);
467  *c++ = ((xmc[28] & 0x3) << 6)
468  | ((xmc[29] & 0x7) << 3)
469  | (xmc[30] & 0x7);
470  *c++ = ((xmc[31] & 0x7) << 5)
471  | ((xmc[32] & 0x7) << 2)
472  | ((xmc[33] >> 1) & 0x3);
473  *c++ = ((xmc[33] & 0x1) << 7)
474  | ((xmc[34] & 0x7) << 4)
475  | ((xmc[35] & 0x7) << 1)
476  | ((xmc[36] >> 2) & 0x1);
477  *c++ = ((xmc[36] & 0x3) << 6)
478  | ((xmc[37] & 0x7) << 3)
479  | (xmc[38] & 0x7);
480 
481 
482  *c++ = ((Nc[3] & 0x7F) << 1)
483 
484 
485  | ((bc[3] >> 1) & 0x1);
486  *c++ = ((bc[3] & 0x1) << 7)
487 
488 
489  | ((Mc[3] & 0x3) << 5)
490 
491 
492  | ((xmaxc[3] >> 1) & 0x1F);
493  *c++ = ((xmaxc[3] & 0x1) << 7)
494 
495 #undef xmc
496 #define xmc (source + 63 - 39)
497 
498  | ((xmc[39] & 0x7) << 4)
499  | ((xmc[40] & 0x7) << 1)
500  | ((xmc[41] >> 2) & 0x1);
501  *c++ = ((xmc[41] & 0x3) << 6) /* 30 */
502  | ((xmc[42] & 0x7) << 3)
503  | (xmc[43] & 0x7);
504  *c++ = ((xmc[44] & 0x7) << 5)
505  | ((xmc[45] & 0x7) << 2)
506  | ((xmc[46] >> 1) & 0x3);
507  *c++ = ((xmc[46] & 0x1) << 7)
508  | ((xmc[47] & 0x7) << 4)
509  | ((xmc[48] & 0x7) << 1)
510  | ((xmc[49] >> 2) & 0x1);
511  *c++ = ((xmc[49] & 0x3) << 6)
512  | ((xmc[50] & 0x7) << 3)
513  | (xmc[51] & 0x7);
514  }
515 }
gsm_state::frame_index
unsigned char frame_index
Definition: codecs/gsm/inc/private.h:39
xmaxc
#define xmaxc
Mc
#define Mc
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
xmc
#define xmc
LARc
#define LARc
uword
unsigned short uword
Definition: codecs/gsm/inc/private.h:15
Nc
#define Nc
gsm_signal
short gsm_signal
Definition: gsm.h:40
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
bc
#define bc
gsm_state
Definition: codecs/gsm/inc/private.h:18
P3
void gsm_implode P3((s, source, c), gsm s, gsm_signal *source, gsm_byte *c)
Definition: gsm_implode.c:14
Generated on Sun Aug 8 2021 19:43:47 for Asterisk - The Open Source Telephony Project by   doxygen 1.8.13