• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
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: /tmp_amd/presto/export/kbs/jutta/src/gsm/RCS/gsm_implode.c,v 1.2 1996/07/02 14:32:43 jutta Exp jutta $ */
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) {
120 			sr = sr >> 6 | LARc[0] << 10;
121 			sr = sr >> 6 | LARc[1] << 10;
122 			*c++ = sr >> 4;
123 			sr = sr >> 5 | LARc[2] << 11;
124 			*c++ = sr >> 7;
125 			sr = sr >> 5 | LARc[3] << 11;
126 			sr = sr >> 4 | LARc[4] << 12;
127 			*c++ = sr >> 6;
128 			sr = sr >> 4 | LARc[5] << 12;
129 			sr = sr >> 3 | LARc[6] << 13;
130 			*c++ = sr >> 7;
131 			sr = sr >> 3 | LARc[7] << 13;
132 			sr = sr >> 7 | Nc[0] << 9;
133 			*c++ = sr >> 5;
134 			sr = sr >> 2 | bc[0] << 14;
135 			sr = sr >> 2 | Mc[0] << 14;
136 			sr = sr >> 6 | xmaxc[0] << 10;
137 			*c++ = sr >> 3;
138 #undef xmc
139 #define	xmc	(source + 12)
140 
141 			sr = sr >> 3 | xmc[0] << 13;
142 			*c++ = sr >> 8;
143 			sr = sr >> 3 | xmc[1] << 13;
144 			sr = sr >> 3 | xmc[2] << 13;
145 			sr = sr >> 3 | xmc[3] << 13;
146 			*c++ = sr >> 7;
147 			sr = sr >> 3 | xmc[4] << 13;
148 			sr = sr >> 3 | xmc[5] << 13;
149 			sr = sr >> 3 | xmc[6] << 13;
150 			*c++ = sr >> 6;
151 			sr = sr >> 3 | xmc[7] << 13;
152 			sr = sr >> 3 | xmc[8] << 13;
153 			*c++ = sr >> 8;
154 			sr = sr >> 3 | xmc[9] << 13;
155 			sr = sr >> 3 | xmc[10] << 13;
156 			sr = sr >> 3 | xmc[11] << 13;
157 			*c++ = sr >> 7;
158 			sr = sr >> 3 | xmc[12] << 13;
159 			sr = sr >> 7 | Nc[1] << 9;
160 			*c++ = sr >> 5;
161 			sr = sr >> 2 | bc[1] << 14;
162 			sr = sr >> 2 | Mc[1] << 14;
163 			sr = sr >> 6 | xmaxc[1] << 10;
164 			*c++ = sr >> 3;
165 #undef	xmc
166 #define	xmc	(source + 29 - 13)
167 
168 			sr = sr >> 3 | xmc[13] << 13;
169 			*c++ = sr >> 8;
170 			sr = sr >> 3 | xmc[14] << 13;
171 			sr = sr >> 3 | xmc[15] << 13;
172 			sr = sr >> 3 | xmc[16] << 13;
173 			*c++ = sr >> 7;
174 			sr = sr >> 3 | xmc[17] << 13;
175 			sr = sr >> 3 | xmc[18] << 13;
176 			sr = sr >> 3 | xmc[19] << 13;
177 			*c++ = sr >> 6;
178 			sr = sr >> 3 | xmc[20] << 13;
179 			sr = sr >> 3 | xmc[21] << 13;
180 			*c++ = sr >> 8;
181 			sr = sr >> 3 | xmc[22] << 13;
182 			sr = sr >> 3 | xmc[23] << 13;
183 			sr = sr >> 3 | xmc[24] << 13;
184 			*c++ = sr >> 7;
185 			sr = sr >> 3 | xmc[25] << 13;
186 			sr = sr >> 7 | Nc[2] << 9;
187 			*c++ = sr >> 5;
188 			sr = sr >> 2 | bc[2] << 14;
189 			sr = sr >> 2 | Mc[2] << 14;
190 			sr = sr >> 6 | xmaxc[2] << 10;
191 			*c++ = sr >> 3;
192 #undef	xmc
193 #define	xmc	(source + 46 - 26)
194 
195 			sr = sr >> 3 | xmc[26] << 13;
196 			*c++ = sr >> 8;
197 			sr = sr >> 3 | xmc[27] << 13;
198 			sr = sr >> 3 | xmc[28] << 13;
199 			sr = sr >> 3 | xmc[29] << 13;
200 			*c++ = sr >> 7;
201 			sr = sr >> 3 | xmc[30] << 13;
202 			sr = sr >> 3 | xmc[31] << 13;
203 			sr = sr >> 3 | xmc[32] << 13;
204 			*c++ = sr >> 6;
205 			sr = sr >> 3 | xmc[33] << 13;
206 			sr = sr >> 3 | xmc[34] << 13;
207 			*c++ = sr >> 8;
208 			sr = sr >> 3 | xmc[35] << 13;
209 			sr = sr >> 3 | xmc[36] << 13;
210 			sr = sr >> 3 | xmc[37] << 13;
211 			*c++ = sr >> 7;
212 			sr = sr >> 3 | xmc[38] << 13;
213 			sr = sr >> 7 | Nc[3] << 9;
214 			*c++ = sr >> 5;
215 			sr = sr >> 2 | bc[3] << 14;
216 			sr = sr >> 2 | Mc[3] << 14;
217 			sr = sr >> 6 | xmaxc[3] << 10;
218 			*c++ = sr >> 3;
219 #undef	xmc
220 #define	xmc	(source + 63 - 39)
221 
222 			sr = sr >> 3 | xmc[39] << 13;
223 			*c++ = sr >> 8;
224 			sr = sr >> 3 | xmc[40] << 13;
225 			sr = sr >> 3 | xmc[41] << 13;
226 			sr = sr >> 3 | xmc[42] << 13;
227 			*c++ = sr >> 7;
228 			sr = sr >> 3 | xmc[43] << 13;
229 			sr = sr >> 3 | xmc[44] << 13;
230 			sr = sr >> 3 | xmc[45] << 13;
231 			*c++ = sr >> 6;
232 			sr = sr >> 3 | xmc[46] << 13;
233 			sr = sr >> 3 | xmc[47] << 13;
234 			*c++ = sr >> 8;
235 			sr = sr >> 3 | xmc[48] << 13;
236 			sr = sr >> 3 | xmc[49] << 13;
237 			sr = sr >> 3 | xmc[50] << 13;
238 			*c++ = sr >> 7;
239 			sr = sr >> 3 | xmc[51] << 13;
240 			sr = sr >> 4;
241 			*c = sr >> 8;
242 			s->frame_chain = *c;
243 		}
244 		else {
245 			sr = sr >> 4 | s->frame_chain << 12;
246 			sr = sr >> 6 | LARc[0] << 10;
247 			*c++ = sr >> 6;
248 			sr = sr >> 6 | LARc[1] << 10;
249 			*c++ = sr >> 8;
250 			sr = sr >> 5 | LARc[2] << 11;
251 			sr = sr >> 5 | LARc[3] << 11;
252 			*c++ = sr >> 6;
253 			sr = sr >> 4 | LARc[4] << 12;
254 			sr = sr >> 4 | LARc[5] << 12;
255 			*c++ = sr >> 6;
256 			sr = sr >> 3 | LARc[6] << 13;
257 			sr = sr >> 3 | LARc[7] << 13;
258 			*c++ = sr >> 8;
259 			sr = sr >> 7 | Nc[0] << 9;
260 			sr = sr >> 2 | bc[0] << 14;
261 			*c++ = sr >> 7;
262 			sr = sr >> 2 | Mc[0] << 14;
263 			sr = sr >> 6 | xmaxc[0] << 10;
264 			*c++ = sr >> 7;
265 #undef xmc
266 #define	xmc	(source + 12)
267 
268 			sr = sr >> 3 | xmc[0] << 13;
269 			sr = sr >> 3 | xmc[1] << 13;
270 			sr = sr >> 3 | xmc[2] << 13;
271 			*c++ = sr >> 6;
272 			sr = sr >> 3 | xmc[3] << 13;
273 			sr = sr >> 3 | xmc[4] << 13;
274 			*c++ = sr >> 8;
275 			sr = sr >> 3 | xmc[5] << 13;
276 			sr = sr >> 3 | xmc[6] << 13;
277 			sr = sr >> 3 | xmc[7] << 13;
278 			*c++ = sr >> 7;
279 			sr = sr >> 3 | xmc[8] << 13;
280 			sr = sr >> 3 | xmc[9] << 13;
281 			sr = sr >> 3 | xmc[10] << 13;
282 			*c++ = sr >> 6;
283 			sr = sr >> 3 | xmc[11] << 13;
284 			sr = sr >> 3 | xmc[12] << 13;
285 			*c++ = sr >> 8;
286 			sr = sr >> 7 | Nc[1] << 9;
287 			sr = sr >> 2 | bc[1] << 14;
288 			*c++ = sr >> 7;
289 			sr = sr >> 2 | Mc[1] << 14;
290 			sr = sr >> 6 | xmaxc[1] << 10;
291 			*c++ = sr >> 7;
292 #undef	xmc
293 #define	xmc	(source + 29 - 13)
294 
295 			sr = sr >> 3 | xmc[13] << 13;
296 			sr = sr >> 3 | xmc[14] << 13;
297 			sr = sr >> 3 | xmc[15] << 13;
298 			*c++ = sr >> 6;
299 			sr = sr >> 3 | xmc[16] << 13;
300 			sr = sr >> 3 | xmc[17] << 13;
301 			*c++ = sr >> 8;
302 			sr = sr >> 3 | xmc[18] << 13;
303 			sr = sr >> 3 | xmc[19] << 13;
304 			sr = sr >> 3 | xmc[20] << 13;
305 			*c++ = sr >> 7;
306 			sr = sr >> 3 | xmc[21] << 13;
307 			sr = sr >> 3 | xmc[22] << 13;
308 			sr = sr >> 3 | xmc[23] << 13;
309 			*c++ = sr >> 6;
310 			sr = sr >> 3 | xmc[24] << 13;
311 			sr = sr >> 3 | xmc[25] << 13;
312 			*c++ = sr >> 8;
313 			sr = sr >> 7 | Nc[2] << 9;
314 			sr = sr >> 2 | bc[2] << 14;
315 			*c++ = sr >> 7;
316 			sr = sr >> 2 | Mc[2] << 14;
317 			sr = sr >> 6 | xmaxc[2] << 10;
318 			*c++ = sr >> 7;
319 #undef	xmc
320 #define	xmc	(source + 46 - 26)
321 
322 			sr = sr >> 3 | xmc[26] << 13;
323 			sr = sr >> 3 | xmc[27] << 13;
324 			sr = sr >> 3 | xmc[28] << 13;
325 			*c++ = sr >> 6;
326 			sr = sr >> 3 | xmc[29] << 13;
327 			sr = sr >> 3 | xmc[30] << 13;
328 			*c++ = sr >> 8;
329 			sr = sr >> 3 | xmc[31] << 13;
330 			sr = sr >> 3 | xmc[32] << 13;
331 			sr = sr >> 3 | xmc[33] << 13;
332 			*c++ = sr >> 7;
333 			sr = sr >> 3 | xmc[34] << 13;
334 			sr = sr >> 3 | xmc[35] << 13;
335 			sr = sr >> 3 | xmc[36] << 13;
336 			*c++ = sr >> 6;
337 			sr = sr >> 3 | xmc[37] << 13;
338 			sr = sr >> 3 | xmc[38] << 13;
339 			*c++ = sr >> 8;
340 			sr = sr >> 7 | Nc[3] << 9;
341 			sr = sr >> 2 | bc[3] << 14;
342 			*c++ = sr >> 7;
343 			sr = sr >> 2 | Mc[3] << 14;
344 			sr = sr >> 6 | xmaxc[3] << 10;
345 			*c++ = sr >> 7;
346 #undef	xmc
347 #define	xmc	(source + 63 - 39)
348 
349 			sr = sr >> 3 | xmc[39] << 13;
350 			sr = sr >> 3 | xmc[40] << 13;
351 			sr = sr >> 3 | xmc[41] << 13;
352 			*c++ = sr >> 6;
353 			sr = sr >> 3 | xmc[42] << 13;
354 			sr = sr >> 3 | xmc[43] << 13;
355 			*c++ = sr >> 8;
356 			sr = sr >> 3 | xmc[44] << 13;
357 			sr = sr >> 3 | xmc[45] << 13;
358 			sr = sr >> 3 | xmc[46] << 13;
359 			*c++ = sr >> 7;
360 			sr = sr >> 3 | xmc[47] << 13;
361 			sr = sr >> 3 | xmc[48] << 13;
362 			sr = sr >> 3 | xmc[49] << 13;
363 			*c++ = sr >> 6;
364 			sr = sr >> 3 | xmc[50] << 13;
365 			sr = sr >> 3 | xmc[51] << 13;
366 			*c++ = sr >> 8;
367 		}
368 	}
369 	else
370 #endif
371 	{
372 
373 		*c++ =   ((GSM_MAGIC & 0xF) << 4)		/* 1 */
374 		       | ((LARc[0] >> 2) & 0xF);
375 		*c++ =   ((LARc[0] & 0x3) << 6)
376 		       | (LARc[1] & 0x3F);
377 		*c++ =   ((LARc[2] & 0x1F) << 3)
378 		       | ((LARc[3] >> 2) & 0x7);
379 		*c++ =   ((LARc[3] & 0x3) << 6)
380 		       | ((LARc[4] & 0xF) << 2)
381 		       | ((LARc[5] >> 2) & 0x3);
382 		*c++ =   ((LARc[5] & 0x3) << 6)
383 		       | ((LARc[6] & 0x7) << 3)
384 		       | (LARc[7] & 0x7);
385 
386 
387 		*c++ =   ((Nc[0] & 0x7F) << 1)
388 
389 
390 		       | ((bc[0] >> 1) & 0x1);
391 		*c++ =   ((bc[0] & 0x1) << 7)
392 
393 
394 		       | ((Mc[0] & 0x3) << 5)
395 
396 		       | ((xmaxc[0] >> 1) & 0x1F);
397 		*c++ =   ((xmaxc[0] & 0x1) << 7)
398 
399 #undef xmc
400 #define	xmc	(source + 12)
401 
402 		       | ((xmc[0] & 0x7) << 4)
403 		       | ((xmc[1] & 0x7) << 1)
404 		       | ((xmc[2] >> 2) & 0x1);
405 		*c++ =   ((xmc[2] & 0x3) << 6)
406 		       | ((xmc[3] & 0x7) << 3)
407 		       | (xmc[4] & 0x7);
408 		*c++ =   ((xmc[5] & 0x7) << 5)			/* 10 */
409 		       | ((xmc[6] & 0x7) << 2)
410 		       | ((xmc[7] >> 1) & 0x3);
411 		*c++ =   ((xmc[7] & 0x1) << 7)
412 		       | ((xmc[8] & 0x7) << 4)
413 		       | ((xmc[9] & 0x7) << 1)
414 		       | ((xmc[10] >> 2) & 0x1);
415 		*c++ =   ((xmc[10] & 0x3) << 6)
416 		       | ((xmc[11] & 0x7) << 3)
417 		       | (xmc[12] & 0x7);
418 
419 
420 		*c++ =   ((Nc[1] & 0x7F) << 1)
421 
422 
423 		       | ((bc[1] >> 1) & 0x1);
424 		*c++ =   ((bc[1] & 0x1) << 7)
425 
426 
427 		       | ((Mc[1] & 0x3) << 5)
428 
429 
430 		       | ((xmaxc[1] >> 1) & 0x1F);
431 		*c++ =   ((xmaxc[1] & 0x1) << 7)
432 
433 #undef	xmc
434 #define	xmc	(source + 29 - 13)
435 
436 		       | ((xmc[13] & 0x7) << 4)
437 		       | ((xmc[14] & 0x7) << 1)
438 		       | ((xmc[15] >> 2) & 0x1);
439 		*c++ =   ((xmc[15] & 0x3) << 6)
440 		       | ((xmc[16] & 0x7) << 3)
441 		       | (xmc[17] & 0x7);
442 		*c++ =   ((xmc[18] & 0x7) << 5)
443 		       | ((xmc[19] & 0x7) << 2)
444 		       | ((xmc[20] >> 1) & 0x3);
445 		*c++ =   ((xmc[20] & 0x1) << 7)
446 		       | ((xmc[21] & 0x7) << 4)
447 		       | ((xmc[22] & 0x7) << 1)
448 		       | ((xmc[23] >> 2) & 0x1);
449 		*c++ =   ((xmc[23] & 0x3) << 6)
450 		       | ((xmc[24] & 0x7) << 3)
451 		       | (xmc[25] & 0x7);
452 
453 
454 		*c++ =   ((Nc[2] & 0x7F) << 1)			/* 20 */
455 
456 
457 		       | ((bc[2] >> 1) & 0x1);
458 		*c++ =   ((bc[2] & 0x1) << 7)
459 
460 
461 		       | ((Mc[2] & 0x3) << 5)
462 
463 
464 		       | ((xmaxc[2] >> 1) & 0x1F);
465 		*c++ =   ((xmaxc[2] & 0x1) << 7)
466 
467 #undef	xmc
468 #define	xmc	(source + 46 - 26)
469 
470 		       | ((xmc[26] & 0x7) << 4)
471 		       | ((xmc[27] & 0x7) << 1)
472 		       | ((xmc[28] >> 2) & 0x1);
473 		*c++ =   ((xmc[28] & 0x3) << 6)
474 		       | ((xmc[29] & 0x7) << 3)
475 		       | (xmc[30] & 0x7);
476 		*c++ =   ((xmc[31] & 0x7) << 5)
477 		       | ((xmc[32] & 0x7) << 2)
478 		       | ((xmc[33] >> 1) & 0x3);
479 		*c++ =   ((xmc[33] & 0x1) << 7)
480 		       | ((xmc[34] & 0x7) << 4)
481 		       | ((xmc[35] & 0x7) << 1)
482 		       | ((xmc[36] >> 2) & 0x1);
483 		*c++ =   ((xmc[36] & 0x3) << 6)
484 		       | ((xmc[37] & 0x7) << 3)
485 		       | (xmc[38] & 0x7);
486 
487 
488 		*c++ =   ((Nc[3] & 0x7F) << 1)
489 
490 
491 		       | ((bc[3] >> 1) & 0x1);
492 		*c++ =   ((bc[3] & 0x1) << 7)
493 
494 
495 		       | ((Mc[3] & 0x3) << 5)
496 
497 
498 		       | ((xmaxc[3] >> 1) & 0x1F);
499 		*c++ =   ((xmaxc[3] & 0x1) << 7)
500 
501 #undef	xmc
502 #define	xmc	(source + 63 - 39)
503 
504 		       | ((xmc[39] & 0x7) << 4)
505 		       | ((xmc[40] & 0x7) << 1)
506 		       | ((xmc[41] >> 2) & 0x1);
507 		*c++ =   ((xmc[41] & 0x3) << 6)			/* 30 */
508 		       | ((xmc[42] & 0x7) << 3)
509 		       | (xmc[43] & 0x7);
510 		*c++ =   ((xmc[44] & 0x7) << 5)
511 		       | ((xmc[45] & 0x7) << 2)
512 		       | ((xmc[46] >> 1) & 0x3);
513 		*c++ =   ((xmc[46] & 0x1) << 7)
514 		       | ((xmc[47] & 0x7) << 4)
515 		       | ((xmc[48] & 0x7) << 1)
516 		       | ((xmc[49] >> 2) & 0x1);
517 		*c++ =   ((xmc[49] & 0x3) << 6)
518 		       | ((xmc[50] & 0x7) << 3)
519 		       | (xmc[51] & 0x7);
520 	}
521 }
522