Asterisk - The Open Source Telephony Project GIT-master-2de1a68
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
13void 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}
short word
unsigned short uword
unsigned char gsm_byte
Definition: gsm.h:41
short gsm_signal
Definition: gsm.h:40
#define GSM_MAGIC
Definition: gsm.h:44
void gsm_encode P3((s, source, c), gsm s, gsm_signal *source, gsm_byte *c)
Definition: gsm_encode.c:13
#define Mc
#define LARc
#define xmc
#define xmaxc
#define bc
#define Nc
unsigned char frame_chain
unsigned char frame_index
static struct test_val c