gsm-codec-lib: libgsmfr2/rpe.c annotate

annotate libgsmfr2/rpe.c @ 521:68fe269b4316

gsmx-to-tw5a: actually write to the output file

author	Mychaela Falconia <falcon@freecalypso.org>
date	Thu, 19 Sep 2024 02:21:08 +0000
parents	bee3a94f42a7
children

rev	line source
270 bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1 /*
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2 * This C source file has been adapted from TU-Berlin libgsm source,
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3 * original notice follows:
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	4 *
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	5 * Copyright 1992 by Jutta Degener and Carsten Bormann, Technische
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	6 * Universitaet Berlin. See the accompanying file "COPYRIGHT" for
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	7 * details. THERE IS ABSOLUTELY NO WARRANTY FOR THIS SOFTWARE.
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	8 */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	9
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	10 #include <stdint.h>
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	11 #include <assert.h>
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	12 #include "tw_gsmfr.h"
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	13 #include "typedef.h"
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	14 #include "ed_state.h"
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	15 #include "ed_internal.h"
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	16
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	17 /* 4.2.13 .. 4.2.17 RPE ENCODING SECTION
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	18 */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	19
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	20 /* 4.2.13 */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	21
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	22 static void Weighting_filter (
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	23 register word * e, /* signal [-5..0.39.44] IN */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	24 word * x /* signal [0..39] OUT */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	25 )
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	26 /*
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	27 * The coefficients of the weighting filter are stored in a table
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	28 * (see table 4.4). The following scaling is used:
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	29 *
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	30 * H[0..10] = integer( real_H[ 0..10] * 8192 );
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	31 */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	32 {
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	33 /* word wt[ 50 ]; */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	34
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	35 register longword L_result;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	36 register int k /* , i */ ;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	37
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	38 /* Initialization of a temporary working array wt[0...49]
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	39 */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	40
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	41 /* for (k = 0; k <= 4; k++) wt[k] = 0;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	42 * for (k = 5; k <= 44; k++) wt[k] = *e++;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	43 * for (k = 45; k <= 49; k++) wt[k] = 0;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	44 *
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	45 * (e[-5..-1] and e[40..44] are allocated by the caller,
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	46 * are initially zero and are not written anywhere.)
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	47 */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	48 e -= 5;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	49
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	50 /* Compute the signal x[0..39]
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	51 */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	52 for (k = 0; k <= 39; k++) {
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	53
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	54 L_result = 8192 >> 1;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	55
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	56 /* for (i = 0; i <= 10; i++) {
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	57 * L_temp = GSM_L_MULT( wt[k+i], gsm_H[i] );
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	58 * L_result = GSM_L_ADD( L_result, L_temp );
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	59 * }
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	60 */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	61
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	62 #undef STEP
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	63 #define STEP( i, H ) (e[ k + i ] * (longword)H)
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	64
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	65 /* Every one of these multiplications is done twice --
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	66 * but I don't see an elegant way to optimize this.
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	67 * Do you?
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	68 */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	69
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	70 #ifdef STUPID_COMPILER
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	71 L_result += STEP( 0, -134 ) ;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	72 L_result += STEP( 1, -374 ) ;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	73 /* + STEP( 2, 0 ) */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	74 L_result += STEP( 3, 2054 ) ;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	75 L_result += STEP( 4, 5741 ) ;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	76 L_result += STEP( 5, 8192 ) ;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	77 L_result += STEP( 6, 5741 ) ;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	78 L_result += STEP( 7, 2054 ) ;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	79 /* + STEP( 8, 0 ) */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	80 L_result += STEP( 9, -374 ) ;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	81 L_result += STEP( 10, -134 ) ;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	82 #else
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	83 L_result +=
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	84 STEP( 0, -134 )
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	85 + STEP( 1, -374 )
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	86 /* + STEP( 2, 0 ) */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	87 + STEP( 3, 2054 )
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	88 + STEP( 4, 5741 )
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	89 + STEP( 5, 8192 )
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	90 + STEP( 6, 5741 )
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	91 + STEP( 7, 2054 )
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	92 /* + STEP( 8, 0 ) */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	93 + STEP( 9, -374 )
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	94 + STEP(10, -134 )
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	95 ;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	96 #endif
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	97
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	98 /* L_result = GSM_L_ADD( L_result, L_result ); (* scaling(x2) *)
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	99 * L_result = GSM_L_ADD( L_result, L_result ); (* scaling(x4) *)
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	100 *
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	101 * x[k] = SASR( L_result, 16 );
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	102 */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	103
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	104 /* 2 adds vs. >>16 => 14, minus one shift to compensate for
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	105 * those we lost when replacing L_MULT by '*'.
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	106 */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	107
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	108 L_result = SASR( L_result, 13 );
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	109 x[k] = ( L_result < MIN_WORD ? MIN_WORD
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	110 : (L_result > MAX_WORD ? MAX_WORD : L_result ));
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	111 }
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	112 }
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	113
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	114 /* 4.2.14 */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	115
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	116 static void RPE_grid_selection (
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	117 word * x, /* [0..39] IN */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	118 word * xM, /* [0..12] OUT */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	119 word * Mc_out /* OUT */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	120 )
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	121 /*
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	122 * The signal x[0..39] is used to select the RPE grid which is
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	123 * represented by Mc.
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	124 */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	125 {
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	126 /* register word temp1; */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	127 register int /* m, */ i;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	128 register longword L_result, L_temp;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	129 longword EM; /* xxx should be L_EM? */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	130 word Mc;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	131
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	132 longword L_common_0_3;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	133
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	134 EM = 0;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	135 Mc = 0;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	136
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	137 /* for (m = 0; m <= 3; m++) {
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	138 * L_result = 0;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	139 *
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	140 *
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	141 * for (i = 0; i <= 12; i++) {
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	142 *
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	143 * temp1 = SASR( x[m + 3*i], 2 );
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	144 *
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	145 * assert(temp1 != MIN_WORD);
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	146 *
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	147 * L_temp = GSM_L_MULT( temp1, temp1 );
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	148 * L_result = GSM_L_ADD( L_temp, L_result );
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	149 * }
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	150 *
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	151 * if (L_result > EM) {
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	152 * Mc = m;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	153 * EM = L_result;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	154 * }
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	155 * }
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	156 */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	157
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	158 #undef STEP
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	159 #define STEP( m, i ) L_temp = SASR( x[m + 3 * i], 2 ); \
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	160 L_result += L_temp * L_temp;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	161
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	162 /* common part of 0 and 3 */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	163
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	164 L_result = 0;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	165 STEP( 0, 1 ); STEP( 0, 2 ); STEP( 0, 3 ); STEP( 0, 4 );
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	166 STEP( 0, 5 ); STEP( 0, 6 ); STEP( 0, 7 ); STEP( 0, 8 );
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	167 STEP( 0, 9 ); STEP( 0, 10); STEP( 0, 11); STEP( 0, 12);
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	168 L_common_0_3 = L_result;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	169
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	170 /* i = 0 */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	171
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	172 STEP( 0, 0 );
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	173 L_result <<= 1; /* implicit in L_MULT */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	174 EM = L_result;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	175
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	176 /* i = 1 */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	177
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	178 L_result = 0;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	179 STEP( 1, 0 );
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	180 STEP( 1, 1 ); STEP( 1, 2 ); STEP( 1, 3 ); STEP( 1, 4 );
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	181 STEP( 1, 5 ); STEP( 1, 6 ); STEP( 1, 7 ); STEP( 1, 8 );
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	182 STEP( 1, 9 ); STEP( 1, 10); STEP( 1, 11); STEP( 1, 12);
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	183 L_result <<= 1;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	184 if (L_result > EM) {
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	185 Mc = 1;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	186 EM = L_result;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	187 }
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	188
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	189 /* i = 2 */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	190
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	191 L_result = 0;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	192 STEP( 2, 0 );
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	193 STEP( 2, 1 ); STEP( 2, 2 ); STEP( 2, 3 ); STEP( 2, 4 );
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	194 STEP( 2, 5 ); STEP( 2, 6 ); STEP( 2, 7 ); STEP( 2, 8 );
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	195 STEP( 2, 9 ); STEP( 2, 10); STEP( 2, 11); STEP( 2, 12);
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	196 L_result <<= 1;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	197 if (L_result > EM) {
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	198 Mc = 2;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	199 EM = L_result;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	200 }
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	201
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	202 /* i = 3 */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	203
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	204 L_result = L_common_0_3;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	205 STEP( 3, 12 );
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	206 L_result <<= 1;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	207 if (L_result > EM) {
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	208 Mc = 3;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	209 EM = L_result;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	210 }
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	211
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	212 /**/
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	213
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	214 /* Down-sampling by a factor 3 to get the selected xM[0..12]
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	215 * RPE sequence.
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	216 */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	217 for (i = 0; i <= 12; i ++) xM[i] = x[Mc + 3*i];
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	218 *Mc_out = Mc;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	219 }
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	220
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	221 /* 4.12.15 */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	222
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	223 static void APCM_quantization_xmaxc_to_exp_mant (
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	224 word xmaxc, /* IN */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	225 word * exp_out, /* OUT */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	226 word * mant_out ) /* OUT */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	227 {
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	228 word exp, mant;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	229
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	230 /* Compute exponent and mantissa of the decoded version of xmaxc
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	231 */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	232
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	233 exp = 0;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	234 if (xmaxc > 15) exp = SASR(xmaxc, 3) - 1;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	235 mant = xmaxc - (exp << 3);
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	236
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	237 if (mant == 0) {
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	238 exp = -4;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	239 mant = 7;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	240 }
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	241 else {
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	242 while (mant <= 7) {
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	243 mant = mant << 1 \| 1;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	244 exp--;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	245 }
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	246 mant -= 8;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	247 }
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	248
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	249 assert( exp >= -4 && exp <= 6 );
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	250 assert( mant >= 0 && mant <= 7 );
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	251
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	252 *exp_out = exp;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	253 *mant_out = mant;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	254 }
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	255
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	256 static void APCM_quantization (
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	257 word * xM, /* [0..12] IN */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	258
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	259 word * xMc, /* [0..12] OUT */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	260 word * mant_out, /* OUT */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	261 word * exp_out, /* OUT */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	262 word * xmaxc_out /* OUT */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	263 )
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	264 {
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	265 int i, itest;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	266
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	267 word xmax, xmaxc, temp, temp1, temp2;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	268 word exp, mant;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	269
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	270 /* Find the maximum absolute value xmax of xM[0..12].
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	271 */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	272
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	273 xmax = 0;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	274 for (i = 0; i <= 12; i++) {
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	275 temp = xM[i];
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	276 temp = GSM_ABS(temp);
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	277 if (temp > xmax) xmax = temp;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	278 }
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	279
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	280 /* Qantizing and coding of xmax to get xmaxc.
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	281 */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	282
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	283 exp = 0;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	284 temp = SASR( xmax, 9 );
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	285 itest = 0;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	286
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	287 for (i = 0; i <= 5; i++) {
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	288 itest \|= (temp <= 0);
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	289 temp = SASR( temp, 1 );
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	290
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	291 assert(exp <= 5);
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	292 if (itest == 0) exp++; /* exp = add (exp, 1) */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	293 }
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	294
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	295 assert(exp <= 6 && exp >= 0);
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	296 temp = exp + 5;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	297
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	298 assert(temp <= 11 && temp >= 0);
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	299 xmaxc = gsm_add( SASR(xmax, temp), exp << 3 );
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	300
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	301 /* Quantizing and coding of the xM[0..12] RPE sequence
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	302 * to get the xMc[0..12]
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	303 */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	304
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	305 APCM_quantization_xmaxc_to_exp_mant( xmaxc, &exp, &mant );
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	306
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	307 /* This computation uses the fact that the decoded version of xmaxc
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	308 * can be calculated by using the exponent and the mantissa part of
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	309 * xmaxc (logarithmic table).
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	310 * So, this method avoids any division and uses only a scaling
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	311 * of the RPE samples by a function of the exponent. A direct
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	312 * multiplication by the inverse of the mantissa (NRFAC[0..7]
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	313 * found in table 4.5) gives the 3 bit coded version xMc[0..12]
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	314 * of the RPE samples.
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	315 */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	316
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	317 /* Direct computation of xMc[0..12] using table 4.5
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	318 */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	319
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	320 assert( exp <= 4096 && exp >= -4096);
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	321 assert( mant >= 0 && mant <= 7 );
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	322
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	323 temp1 = 6 - exp; /* normalization by the exponent */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	324 temp2 = gsm_NRFAC[ mant ]; /* inverse mantissa */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	325
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	326 for (i = 0; i <= 12; i++) {
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	327 assert(temp1 >= 0 && temp1 < 16);
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	328
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	329 temp = xM[i] << temp1;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	330 temp = GSM_MULT( temp, temp2 );
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	331 temp = SASR(temp, 12);
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	332 xMc[i] = temp + 4; /* see note below */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	333 }
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	334
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	335 /* NOTE: This equation is used to make all the xMc[i] positive.
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	336 */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	337
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	338 *mant_out = mant;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	339 *exp_out = exp;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	340 *xmaxc_out = xmaxc;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	341 }
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	342
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	343 /* 4.2.16 */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	344
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	345 static void APCM_inverse_quantization (
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	346 const word * xMc, /* [0..12] IN */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	347 word mant,
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	348 word exp,
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	349 register word * xMp) /* [0..12] OUT */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	350 /*
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	351 * This part is for decoding the RPE sequence of coded xMc[0..12]
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	352 * samples to obtain the xMp[0..12] array. Table 4.6 is used to get
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	353 * the mantissa of xmaxc (FAC[0..7]).
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	354 */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	355 {
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	356 int i;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	357 word temp, temp1, temp2, temp3;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	358 longword ltmp;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	359
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	360 assert( mant >= 0 && mant <= 7 );
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	361
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	362 temp1 = gsm_FAC[ mant ]; /* see 4.2-15 for mant */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	363 temp2 = gsm_sub( 6, exp ); /* see 4.2-15 for exp */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	364 temp3 = gsm_asl( 1, gsm_sub( temp2, 1 ));
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	365
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	366 for (i = 13; i--;) {
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	367 assert( xMc <= 7 && xMc >= 0 ); /* 3 bit unsigned */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	368
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	369 /* temp = gsm_sub( xMc++ << 1, 7 ); /
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	370 temp = (xMc++ << 1) - 7; / restore sign */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	371 assert( temp <= 7 && temp >= -7 ); /* 4 bit signed */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	372
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	373 temp <<= 12; /* 16 bit signed */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	374 temp = GSM_MULT_R( temp1, temp );
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	375 temp = GSM_ADD( temp, temp3 );
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	376 *xMp++ = gsm_asr( temp, temp2 );
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	377 }
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	378 }
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	379
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	380 /* 4.2.17 */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	381
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	382 static void RPE_grid_positioning (
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	383 word Mc, /* grid position IN */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	384 register word * xMp, /* [0..12] IN */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	385 register word * ep /* [0..39] OUT */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	386 )
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	387 /*
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	388 * This procedure computes the reconstructed long term residual signal
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	389 * ep[0..39] for the LTP analysis filter. The inputs are the Mc
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	390 * which is the grid position selection and the xMp[0..12] decoded
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	391 * RPE samples which are upsampled by a factor of 3 by inserting zero
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	392 * values.
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	393 */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	394 {
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	395 int i = 13;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	396
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	397 assert(0 <= Mc && Mc <= 3);
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	398
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	399 switch (Mc) {
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	400 case 3: *ep++ = 0;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	401 case 2: do {
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	402 *ep++ = 0;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	403 case 1: *ep++ = 0;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	404 case 0: ep++ = xMp++;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	405 } while (--i);
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	406 }
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	407 while (++Mc < 4) *ep++ = 0;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	408
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	409 /*
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	410
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	411 int i, k;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	412 for (k = 0; k <= 39; k++) ep[k] = 0;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	413 for (i = 0; i <= 12; i++) {
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	414 ep[ Mc + (3*i) ] = xMp[i];
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	415 }
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	416 */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	417 }
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	418
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	419 /* 4.2.18 */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	420
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	421 /* This procedure adds the reconstructed long term residual signal
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	422 * ep[0..39] to the estimated signal dpp[0..39] from the long term
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	423 * analysis filter to compute the reconstructed short term residual
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	424 * signal dp[-40..-1]; also the reconstructed short term residual
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	425 * array dp[-120..-41] is updated.
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	426 */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	427
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	428 #if 0 /* Has been inlined in code.c */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	429 void Gsm_Update_of_reconstructed_short_time_residual_signal P3((dpp, ep, dp),
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	430 word * dpp, /* [0...39] IN */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	431 word * ep, /* [0...39] IN */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	432 word * dp) /* [-120...-1] IN/OUT */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	433 {
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	434 int k;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	435
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	436 for (k = 0; k <= 79; k++)
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	437 dp[ -120 + k ] = dp[ -80 + k ];
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	438
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	439 for (k = 0; k <= 39; k++)
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	440 dp[ -40 + k ] = gsm_add( ep[k], dpp[k] );
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	441 }
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	442 #endif /* Has been inlined in code.c */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	443
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	444 void Gsm_RPE_Encoding (
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	445 struct gsmfr_0610_state * S,
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	446
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	447 word * e, /* -5..-1][0..39][40..44 IN/OUT */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	448 word * xmaxc, /* OUT */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	449 word * Mc, /* OUT */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	450 word * xMc) /* [0..12] OUT */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	451 {
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	452 word x[40];
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	453 word xM[13], xMp[13];
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	454 word mant, exp;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	455
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	456 Weighting_filter(e, x);
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	457 RPE_grid_selection(x, xM, Mc);
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	458
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	459 APCM_quantization( xM, xMc, &mant, &exp, xmaxc);
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	460 APCM_inverse_quantization( xMc, mant, exp, xMp);
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	461
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	462 RPE_grid_positioning( *Mc, xMp, e );
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	463 }
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	464
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	465 void Gsm_RPE_Decoding (
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	466 struct gsmfr_0610_state * S,
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	467
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	468 word xmaxcr,
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	469 word Mcr,
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	470 const word * xMcr, /* [0..12], 3 bits IN */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	471 word * erp /* [0..39] OUT */
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	472 )
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	473 {
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	474 word exp, mant;
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	475 word xMp[ 13 ];
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	476
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	477 APCM_quantization_xmaxc_to_exp_mant( xmaxcr, &exp, &mant );
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	478 APCM_inverse_quantization( xMcr, mant, exp, xMp );
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	479 RPE_grid_positioning( Mcr, xMp, erp );
bee3a94f42a7 libgsmfr2: integrate rpe.c from libgsm Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	480 }

FreeCalypso > hg > gsm-codec-lib

annotate libgsmfr2/rpe.c @ 521:68fe269b4316