PageRenderTime 63ms CodeModel.GetById 16ms app.highlight 42ms RepoModel.GetById 2ms app.codeStats 0ms

/project/jni/sndfile/src/GSM610/gsm_decode.c

https://github.com/aichunyu/FFPlayer
C | 359 lines | 340 code | 13 blank | 6 comment | 5 complexity | f4de9282d9851cb0e23161e769b50108 MD5 | raw 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#include "gsm610_priv.h"
  8
  9#include "gsm.h"
 10
 11int gsm_decode (gsm s, gsm_byte * c, gsm_signal * target)
 12{
 13	word  	LARc[8], Nc[4], Mc[4], bc[4], xmaxc[4], xmc[13*4];
 14
 15#ifdef WAV49
 16	if (s->wav_fmt) {
 17
 18		uword sr = 0;
 19
 20		s->frame_index = !s->frame_index;
 21		if (s->frame_index) {
 22
 23			sr = *c++;
 24			LARc[0] = sr & 0x3f;  sr >>= 6;
 25			sr |= (uword)*c++ << 2;
 26			LARc[1] = sr & 0x3f;  sr >>= 6;
 27			sr |= (uword)*c++ << 4;
 28			LARc[2] = sr & 0x1f;  sr >>= 5;
 29			LARc[3] = sr & 0x1f;  sr >>= 5;
 30			sr |= (uword)*c++ << 2;
 31			LARc[4] = sr & 0xf;  sr >>= 4;
 32			LARc[5] = sr & 0xf;  sr >>= 4;
 33			sr |= (uword)*c++ << 2;			/* 5 */
 34			LARc[6] = sr & 0x7;  sr >>= 3;
 35			LARc[7] = sr & 0x7;  sr >>= 3;
 36			sr |= (uword)*c++ << 4;
 37			Nc[0] = sr & 0x7f;  sr >>= 7;
 38			bc[0] = sr & 0x3;  sr >>= 2;
 39			Mc[0] = sr & 0x3;  sr >>= 2;
 40			sr |= (uword)*c++ << 1;
 41			xmaxc[0] = sr & 0x3f;  sr >>= 6;
 42			xmc[0] = sr & 0x7;  sr >>= 3;
 43			sr = *c++;
 44			xmc[1] = sr & 0x7;  sr >>= 3;
 45			xmc[2] = sr & 0x7;  sr >>= 3;
 46			sr |= (uword)*c++ << 2;
 47			xmc[3] = sr & 0x7;  sr >>= 3;
 48			xmc[4] = sr & 0x7;  sr >>= 3;
 49			xmc[5] = sr & 0x7;  sr >>= 3;
 50			sr |= (uword)*c++ << 1;			/* 10 */
 51			xmc[6] = sr & 0x7;  sr >>= 3;
 52			xmc[7] = sr & 0x7;  sr >>= 3;
 53			xmc[8] = sr & 0x7;  sr >>= 3;
 54			sr = *c++;
 55			xmc[9] = sr & 0x7;  sr >>= 3;
 56			xmc[10] = sr & 0x7;  sr >>= 3;
 57			sr |= (uword)*c++ << 2;
 58			xmc[11] = sr & 0x7;  sr >>= 3;
 59			xmc[12] = sr & 0x7;  sr >>= 3;
 60			sr |= (uword)*c++ << 4;
 61			Nc[1] = sr & 0x7f;  sr >>= 7;
 62			bc[1] = sr & 0x3;  sr >>= 2;
 63			Mc[1] = sr & 0x3;  sr >>= 2;
 64			sr |= (uword)*c++ << 1;
 65			xmaxc[1] = sr & 0x3f;  sr >>= 6;
 66			xmc[13] = sr & 0x7;  sr >>= 3;
 67			sr = *c++;				/* 15 */
 68			xmc[14] = sr & 0x7;  sr >>= 3;
 69			xmc[15] = sr & 0x7;  sr >>= 3;
 70			sr |= (uword)*c++ << 2;
 71			xmc[16] = sr & 0x7;  sr >>= 3;
 72			xmc[17] = sr & 0x7;  sr >>= 3;
 73			xmc[18] = sr & 0x7;  sr >>= 3;
 74			sr |= (uword)*c++ << 1;
 75			xmc[19] = sr & 0x7;  sr >>= 3;
 76			xmc[20] = sr & 0x7;  sr >>= 3;
 77			xmc[21] = sr & 0x7;  sr >>= 3;
 78			sr = *c++;
 79			xmc[22] = sr & 0x7;  sr >>= 3;
 80			xmc[23] = sr & 0x7;  sr >>= 3;
 81			sr |= (uword)*c++ << 2;
 82			xmc[24] = sr & 0x7;  sr >>= 3;
 83			xmc[25] = sr & 0x7;  sr >>= 3;
 84			sr |= (uword)*c++ << 4;			/* 20 */
 85			Nc[2] = sr & 0x7f;  sr >>= 7;
 86			bc[2] = sr & 0x3;  sr >>= 2;
 87			Mc[2] = sr & 0x3;  sr >>= 2;
 88			sr |= (uword)*c++ << 1;
 89			xmaxc[2] = sr & 0x3f;  sr >>= 6;
 90			xmc[26] = sr & 0x7;  sr >>= 3;
 91			sr = *c++;
 92			xmc[27] = sr & 0x7;  sr >>= 3;
 93			xmc[28] = sr & 0x7;  sr >>= 3;
 94			sr |= (uword)*c++ << 2;
 95			xmc[29] = sr & 0x7;  sr >>= 3;
 96			xmc[30] = sr & 0x7;  sr >>= 3;
 97			xmc[31] = sr & 0x7;  sr >>= 3;
 98			sr |= (uword)*c++ << 1;
 99			xmc[32] = sr & 0x7;  sr >>= 3;
100			xmc[33] = sr & 0x7;  sr >>= 3;
101			xmc[34] = sr & 0x7;  sr >>= 3;
102			sr = *c++;				/* 25 */
103			xmc[35] = sr & 0x7;  sr >>= 3;
104			xmc[36] = sr & 0x7;  sr >>= 3;
105			sr |= (uword)*c++ << 2;
106			xmc[37] = sr & 0x7;  sr >>= 3;
107			xmc[38] = sr & 0x7;  sr >>= 3;
108			sr |= (uword)*c++ << 4;
109			Nc[3] = sr & 0x7f;  sr >>= 7;
110			bc[3] = sr & 0x3;  sr >>= 2;
111			Mc[3] = sr & 0x3;  sr >>= 2;
112			sr |= (uword)*c++ << 1;
113			xmaxc[3] = sr & 0x3f;  sr >>= 6;
114			xmc[39] = sr & 0x7;  sr >>= 3;
115			sr = *c++;
116			xmc[40] = sr & 0x7;  sr >>= 3;
117			xmc[41] = sr & 0x7;  sr >>= 3;
118			sr |= (uword)*c++ << 2;			/* 30 */
119			xmc[42] = sr & 0x7;  sr >>= 3;
120			xmc[43] = sr & 0x7;  sr >>= 3;
121			xmc[44] = sr & 0x7;  sr >>= 3;
122			sr |= (uword)*c++ << 1;
123			xmc[45] = sr & 0x7;  sr >>= 3;
124			xmc[46] = sr & 0x7;  sr >>= 3;
125			xmc[47] = sr & 0x7;  sr >>= 3;
126			sr = *c++;
127			xmc[48] = sr & 0x7;  sr >>= 3;
128			xmc[49] = sr & 0x7;  sr >>= 3;
129			sr |= (uword)*c++ << 2;
130			xmc[50] = sr & 0x7;  sr >>= 3;
131			xmc[51] = sr & 0x7;  sr >>= 3;
132
133			s->frame_chain = sr & 0xf;
134		}
135		else {
136			sr = s->frame_chain;
137			sr |= (uword)*c++ << 4;			/* 1 */
138			LARc[0] = sr & 0x3f;  sr >>= 6;
139			LARc[1] = sr & 0x3f;  sr >>= 6;
140			sr = *c++;
141			LARc[2] = sr & 0x1f;  sr >>= 5;
142			sr |= (uword)*c++ << 3;
143			LARc[3] = sr & 0x1f;  sr >>= 5;
144			LARc[4] = sr & 0xf;  sr >>= 4;
145			sr |= (uword)*c++ << 2;
146			LARc[5] = sr & 0xf;  sr >>= 4;
147			LARc[6] = sr & 0x7;  sr >>= 3;
148			LARc[7] = sr & 0x7;  sr >>= 3;
149			sr = *c++;				/* 5 */
150			Nc[0] = sr & 0x7f;  sr >>= 7;
151			sr |= (uword)*c++ << 1;
152			bc[0] = sr & 0x3;  sr >>= 2;
153			Mc[0] = sr & 0x3;  sr >>= 2;
154			sr |= (uword)*c++ << 5;
155			xmaxc[0] = sr & 0x3f;  sr >>= 6;
156			xmc[0] = sr & 0x7;  sr >>= 3;
157			xmc[1] = sr & 0x7;  sr >>= 3;
158			sr |= (uword)*c++ << 1;
159			xmc[2] = sr & 0x7;  sr >>= 3;
160			xmc[3] = sr & 0x7;  sr >>= 3;
161			xmc[4] = sr & 0x7;  sr >>= 3;
162			sr = *c++;
163			xmc[5] = sr & 0x7;  sr >>= 3;
164			xmc[6] = sr & 0x7;  sr >>= 3;
165			sr |= (uword)*c++ << 2;			/* 10 */
166			xmc[7] = sr & 0x7;  sr >>= 3;
167			xmc[8] = sr & 0x7;  sr >>= 3;
168			xmc[9] = sr & 0x7;  sr >>= 3;
169			sr |= (uword)*c++ << 1;
170			xmc[10] = sr & 0x7;  sr >>= 3;
171			xmc[11] = sr & 0x7;  sr >>= 3;
172			xmc[12] = sr & 0x7;  sr >>= 3;
173			sr = *c++;
174			Nc[1] = sr & 0x7f;  sr >>= 7;
175			sr |= (uword)*c++ << 1;
176			bc[1] = sr & 0x3;  sr >>= 2;
177			Mc[1] = sr & 0x3;  sr >>= 2;
178			sr |= (uword)*c++ << 5;
179			xmaxc[1] = sr & 0x3f;  sr >>= 6;
180			xmc[13] = sr & 0x7;  sr >>= 3;
181			xmc[14] = sr & 0x7;  sr >>= 3;
182			sr |= (uword)*c++ << 1;			/* 15 */
183			xmc[15] = sr & 0x7;  sr >>= 3;
184			xmc[16] = sr & 0x7;  sr >>= 3;
185			xmc[17] = sr & 0x7;  sr >>= 3;
186			sr = *c++;
187			xmc[18] = sr & 0x7;  sr >>= 3;
188			xmc[19] = sr & 0x7;  sr >>= 3;
189			sr |= (uword)*c++ << 2;
190			xmc[20] = sr & 0x7;  sr >>= 3;
191			xmc[21] = sr & 0x7;  sr >>= 3;
192			xmc[22] = sr & 0x7;  sr >>= 3;
193			sr |= (uword)*c++ << 1;
194			xmc[23] = sr & 0x7;  sr >>= 3;
195			xmc[24] = sr & 0x7;  sr >>= 3;
196			xmc[25] = sr & 0x7;  sr >>= 3;
197			sr = *c++;
198			Nc[2] = sr & 0x7f;  sr >>= 7;
199			sr |= (uword)*c++ << 1;			/* 20 */
200			bc[2] = sr & 0x3;  sr >>= 2;
201			Mc[2] = sr & 0x3;  sr >>= 2;
202			sr |= (uword)*c++ << 5;
203			xmaxc[2] = sr & 0x3f;  sr >>= 6;
204			xmc[26] = sr & 0x7;  sr >>= 3;
205			xmc[27] = sr & 0x7;  sr >>= 3;
206			sr |= (uword)*c++ << 1;	
207			xmc[28] = sr & 0x7;  sr >>= 3;
208			xmc[29] = sr & 0x7;  sr >>= 3;
209			xmc[30] = sr & 0x7;  sr >>= 3;
210			sr = *c++;
211			xmc[31] = sr & 0x7;  sr >>= 3;
212			xmc[32] = sr & 0x7;  sr >>= 3;
213			sr |= (uword)*c++ << 2;
214			xmc[33] = sr & 0x7;  sr >>= 3;
215			xmc[34] = sr & 0x7;  sr >>= 3;
216			xmc[35] = sr & 0x7;  sr >>= 3;
217			sr |= (uword)*c++ << 1;			/* 25 */
218			xmc[36] = sr & 0x7;  sr >>= 3;
219			xmc[37] = sr & 0x7;  sr >>= 3;
220			xmc[38] = sr & 0x7;  sr >>= 3;
221			sr = *c++;
222			Nc[3] = sr & 0x7f;  sr >>= 7;
223			sr |= (uword)*c++ << 1;		
224			bc[3] = sr & 0x3;  sr >>= 2;
225			Mc[3] = sr & 0x3;  sr >>= 2;
226			sr |= (uword)*c++ << 5;
227			xmaxc[3] = sr & 0x3f;  sr >>= 6;
228			xmc[39] = sr & 0x7;  sr >>= 3;
229			xmc[40] = sr & 0x7;  sr >>= 3;
230			sr |= (uword)*c++ << 1;
231			xmc[41] = sr & 0x7;  sr >>= 3;
232			xmc[42] = sr & 0x7;  sr >>= 3;
233			xmc[43] = sr & 0x7;  sr >>= 3;
234			sr = *c++;				/* 30 */
235			xmc[44] = sr & 0x7;  sr >>= 3;
236			xmc[45] = sr & 0x7;  sr >>= 3;
237			sr |= (uword)*c++ << 2;
238			xmc[46] = sr & 0x7;  sr >>= 3;
239			xmc[47] = sr & 0x7;  sr >>= 3;
240			xmc[48] = sr & 0x7;  sr >>= 3;
241			sr |= (uword)*c++ << 1;
242			xmc[49] = sr & 0x7;  sr >>= 3;
243			xmc[50] = sr & 0x7;  sr >>= 3;
244			xmc[51] = sr & 0x7;  sr >>= 3;
245		}
246	}
247	else
248#endif
249	{
250		/* GSM_MAGIC  = (*c >> 4) & 0xF; */
251
252		if (((*c >> 4) & 0x0F) != GSM_MAGIC) return -1;
253
254		LARc[0]  = (*c++ & 0xF) << 2;		/* 1 */
255		LARc[0] |= (*c >> 6) & 0x3;
256		LARc[1]  = *c++ & 0x3F;
257		LARc[2]  = (*c >> 3) & 0x1F;
258		LARc[3]  = (*c++ & 0x7) << 2;
259		LARc[3] |= (*c >> 6) & 0x3;
260		LARc[4]  = (*c >> 2) & 0xF;
261		LARc[5]  = (*c++ & 0x3) << 2;
262		LARc[5] |= (*c >> 6) & 0x3;
263		LARc[6]  = (*c >> 3) & 0x7;
264		LARc[7]  = *c++ & 0x7;
265		Nc[0]  = (*c >> 1) & 0x7F;
266		bc[0]  = (*c++ & 0x1) << 1;
267		bc[0] |= (*c >> 7) & 0x1;
268		Mc[0]  = (*c >> 5) & 0x3;
269		xmaxc[0]  = (*c++ & 0x1F) << 1;
270		xmaxc[0] |= (*c >> 7) & 0x1;
271		xmc[0]  = (*c >> 4) & 0x7;
272		xmc[1]  = (*c >> 1) & 0x7;
273		xmc[2]  = (*c++ & 0x1) << 2;
274		xmc[2] |= (*c >> 6) & 0x3;
275		xmc[3]  = (*c >> 3) & 0x7;
276		xmc[4]  = *c++ & 0x7;
277		xmc[5]  = (*c >> 5) & 0x7;
278		xmc[6]  = (*c >> 2) & 0x7;
279		xmc[7]  = (*c++ & 0x3) << 1;		/* 10 */
280		xmc[7] |= (*c >> 7) & 0x1;
281		xmc[8]  = (*c >> 4) & 0x7;
282		xmc[9]  = (*c >> 1) & 0x7;
283		xmc[10]  = (*c++ & 0x1) << 2;
284		xmc[10] |= (*c >> 6) & 0x3;
285		xmc[11]  = (*c >> 3) & 0x7;
286		xmc[12]  = *c++ & 0x7;
287		Nc[1]  = (*c >> 1) & 0x7F;
288		bc[1]  = (*c++ & 0x1) << 1;
289		bc[1] |= (*c >> 7) & 0x1;
290		Mc[1]  = (*c >> 5) & 0x3;
291		xmaxc[1]  = (*c++ & 0x1F) << 1;
292		xmaxc[1] |= (*c >> 7) & 0x1;
293		xmc[13]  = (*c >> 4) & 0x7;
294		xmc[14]  = (*c >> 1) & 0x7;
295		xmc[15]  = (*c++ & 0x1) << 2;
296		xmc[15] |= (*c >> 6) & 0x3;
297		xmc[16]  = (*c >> 3) & 0x7;
298		xmc[17]  = *c++ & 0x7;
299		xmc[18]  = (*c >> 5) & 0x7;
300		xmc[19]  = (*c >> 2) & 0x7;
301		xmc[20]  = (*c++ & 0x3) << 1;
302		xmc[20] |= (*c >> 7) & 0x1;
303		xmc[21]  = (*c >> 4) & 0x7;
304		xmc[22]  = (*c >> 1) & 0x7;
305		xmc[23]  = (*c++ & 0x1) << 2;
306		xmc[23] |= (*c >> 6) & 0x3;
307		xmc[24]  = (*c >> 3) & 0x7;
308		xmc[25]  = *c++ & 0x7;
309		Nc[2]  = (*c >> 1) & 0x7F;
310		bc[2]  = (*c++ & 0x1) << 1;		/* 20 */
311		bc[2] |= (*c >> 7) & 0x1;
312		Mc[2]  = (*c >> 5) & 0x3;
313		xmaxc[2]  = (*c++ & 0x1F) << 1;
314		xmaxc[2] |= (*c >> 7) & 0x1;
315		xmc[26]  = (*c >> 4) & 0x7;
316		xmc[27]  = (*c >> 1) & 0x7;
317		xmc[28]  = (*c++ & 0x1) << 2;
318		xmc[28] |= (*c >> 6) & 0x3;
319		xmc[29]  = (*c >> 3) & 0x7;
320		xmc[30]  = *c++ & 0x7;
321		xmc[31]  = (*c >> 5) & 0x7;
322		xmc[32]  = (*c >> 2) & 0x7;
323		xmc[33]  = (*c++ & 0x3) << 1;
324		xmc[33] |= (*c >> 7) & 0x1;
325		xmc[34]  = (*c >> 4) & 0x7;
326		xmc[35]  = (*c >> 1) & 0x7;
327		xmc[36]  = (*c++ & 0x1) << 2;
328		xmc[36] |= (*c >> 6) & 0x3;
329		xmc[37]  = (*c >> 3) & 0x7;
330		xmc[38]  = *c++ & 0x7;
331		Nc[3]  = (*c >> 1) & 0x7F;
332		bc[3]  = (*c++ & 0x1) << 1;
333		bc[3] |= (*c >> 7) & 0x1;
334		Mc[3]  = (*c >> 5) & 0x3;
335		xmaxc[3]  = (*c++ & 0x1F) << 1;
336		xmaxc[3] |= (*c >> 7) & 0x1;
337		xmc[39]  = (*c >> 4) & 0x7;
338		xmc[40]  = (*c >> 1) & 0x7;
339		xmc[41]  = (*c++ & 0x1) << 2;
340		xmc[41] |= (*c >> 6) & 0x3;
341		xmc[42]  = (*c >> 3) & 0x7;
342		xmc[43]  = *c++ & 0x7;			/* 30  */
343		xmc[44]  = (*c >> 5) & 0x7;
344		xmc[45]  = (*c >> 2) & 0x7;
345		xmc[46]  = (*c++ & 0x3) << 1;
346		xmc[46] |= (*c >> 7) & 0x1;
347		xmc[47]  = (*c >> 4) & 0x7;
348		xmc[48]  = (*c >> 1) & 0x7;
349		xmc[49]  = (*c++ & 0x1) << 2;
350		xmc[49] |= (*c >> 6) & 0x3;
351		xmc[50]  = (*c >> 3) & 0x7;
352		xmc[51]  = *c & 0x7;			/* 33 */
353	}
354
355	Gsm_Decoder(s, LARc, Nc, bc, Mc, xmaxc, xmc, target);
356
357	return 0;
358}
359