efr-experiments: src/c1035pf.c annotate

annotate src/c1035pf.c @ 8:8b17df8f6340 default tip

add README

author	Mychaela Falconia <falcon@freecalypso.org>
date	Wed, 17 Apr 2024 17:30:25 +0000
parents	56410792419a
children

rev	line source
0 56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1 #include "typedef.h"
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2 #include "basic_op.h"
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3 #include "sig_proc.h"
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	4 #include "count.h"
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	5
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	6 #define L_CODE 40
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	7 #define NB_TRACK 5
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	8 #define NB_PULSE 10
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	9 #define STEP 5
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	10
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	11 /* local functions */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	12
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	13 void cor_h_x (
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	14 Word16 h[], /* (i) : impulse response of weighted synthesis filter */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	15 Word16 x[], /* (i) : target */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	16 Word16 dn[] /* (o) : correlation between target and h[] */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	17 );
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	18
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	19 void set_sign (
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	20 Word16 dn[], /* (i/o) : correlation between target and h[] */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	21 Word16 cn[], /* (i) : residual after long term prediction */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	22 Word16 sign[], /* (o) : sign of d[n] */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	23 Word16 pos_max[], /* (o) : position of maximum of dn[] */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	24 Word16 ipos[] /* (o) : starting position for each pulse */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	25 );
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	26
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	27 void cor_h (
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	28 Word16 h[], /* (i) : impulse response of weighted synthesis
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	29 filter */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	30 Word16 sign[], /* (i) : sign of d[n] */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	31 Word16 rr[][L_CODE] /* (o) : matrix of autocorrelation */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	32 );
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	33 void search_10i40 (
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	34 Word16 dn[], /* (i) : correlation between target and h[] */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	35 Word16 rr[][L_CODE], /* (i) : matrix of autocorrelation */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	36 Word16 ipos[], /* (i) : starting position for each pulse */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	37 Word16 pos_max[], /* (i) : position of maximum of dn[] */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	38 Word16 codvec[] /* (o) : algebraic codebook vector */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	39 );
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	40 void build_code (
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	41 Word16 codvec[], /* (i) : algebraic codebook vector */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	42 Word16 sign[], /* (i) : sign of dn[] */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	43 Word16 cod[], /* (o) : algebraic (fixed) codebook excitation */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	44 Word16 h[], /* (i) : impulse response of weighted synthesis filter*/
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	45 Word16 y[], /* (o) : filtered fixed codebook excitation */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	46 Word16 indx[] /* (o) : index of 10 pulses (position+sign+ampl)10 /
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	47 );
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	48
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	49 void q_p (
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	50 Word16 ind, / Pulse position */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	51 Word16 n /* Pulse number */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	52 );
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	53
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	54 /*************************************************************************
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	55 *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	56 * FUNCTION: code_10i40_35bits()
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	57 *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	58 * PURPOSE: Searches a 35 bit algebraic codebook containing 10 pulses
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	59 * in a frame of 40 samples.
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	60 *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	61 * DESCRIPTION:
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	62 * The code contains 10 nonzero pulses: i0...i9.
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	63 * All pulses can have two possible amplitudes: +1 or -1.
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	64 * The 40 positions in a subframe are divided into 5 tracks of
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	65 * interleaved positions. Each track contains two pulses.
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	66 * The pulses can have the following possible positions:
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	67 *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	68 * i0, i5 : 0, 5, 10, 15, 20, 25, 30, 35.
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	69 * i1, i6 : 1, 6, 11, 16, 21, 26, 31, 36.
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	70 * i2, i7 : 2, 7, 12, 17, 22, 27, 32, 37.
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	71 * i3, i8 : 3, 8, 13, 18, 23, 28, 33, 38.
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	72 * i4, i9 : 4, 9, 14, 19, 24, 29, 34, 39.
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	73 *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	74 * Each pair of pulses require 1 bit for their signs and 6 bits for their
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	75 * positions (3 bits + 3 bits). This results in a 35 bit codebook.
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	76 * The function determines the optimal pulse signs and positions, builds
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	77 * the codevector, and computes the filtered codevector.
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	78 *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	79 *************************************************************************/
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	80
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	81 void code_10i40_35bits (
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	82 Word16 x[], /* (i) : target vector */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	83 Word16 cn[], /* (i) : residual after long term prediction */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	84 Word16 h[], /* (i) : impulse response of weighted synthesis filter
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	85 h[-L_subfr..-1] must be set to zero */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	86 Word16 cod[], /* (o) : algebraic (fixed) codebook excitation */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	87 Word16 y[], /* (o) : filtered fixed codebook excitation */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	88 Word16 indx[] /* (o) : index of 10 pulses (sign + position) */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	89 )
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	90 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	91 Word16 ipos[NB_PULSE], pos_max[NB_TRACK], codvec[NB_PULSE];
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	92 Word16 dn[L_CODE], sign[L_CODE];
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	93 Word16 rr[L_CODE][L_CODE], i;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	94
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	95 cor_h_x (h, x, dn);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	96 set_sign (dn, cn, sign, pos_max, ipos);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	97 cor_h (h, sign, rr);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	98 search_10i40 (dn, rr, ipos, pos_max, codvec);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	99 build_code (codvec, sign, cod, h, y, indx);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	100 for (i = 0; i < 10; i++)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	101 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	102 q_p (&indx[i], i);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	103 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	104 return;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	105 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	106
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	107 /*************************************************************************
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	108 *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	109 * FUNCTION: cor_h_x()
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	110 *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	111 * PURPOSE: Computes correlation between target signal "x[]" and
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	112 * impulse response"h[]".
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	113 *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	114 * DESCRIPTION:
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	115 * The correlation is given by:
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	116 * d[n] = sum_{i=n}^{L-1} x[i] h[i-n] n=0,...,L-1
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	117 *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	118 * d[n] is normalized such that the sum of 5 maxima of d[n] corresponding
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	119 * to each position track does not saturate.
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	120 *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	121 *************************************************************************/
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	122 void cor_h_x (
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	123 Word16 h[], /* (i) : impulse response of weighted synthesis filter */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	124 Word16 x[], /* (i) : target */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	125 Word16 dn[] /* (o) : correlation between target and h[] */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	126 )
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	127 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	128 Word16 i, j, k;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	129 Word32 s, y32[L_CODE], max, tot;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	130
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	131 /* first keep the result on 32 bits and find absolute maximum */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	132
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	133 tot = 5; move32 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	134
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	135 for (k = 0; k < NB_TRACK; k++)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	136 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	137 max = 0; move32 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	138 for (i = k; i < L_CODE; i += STEP)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	139 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	140 s = 0; move32 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	141 for (j = i; j < L_CODE; j++)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	142 s = L_mac (s, x[j], h[j - i]);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	143
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	144 y32[i] = s; move32 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	145
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	146 s = L_abs (s);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	147 test ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	148 if (L_sub (s, max) > (Word32) 0L)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	149 max = s; move32 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	150 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	151 tot = L_add (tot, L_shr (max, 1));
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	152 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	153
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	154 j = sub (norm_l (tot), 2); /* multiply tot by 4 */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	155
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	156 for (i = 0; i < L_CODE; i++)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	157 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	158 dn[i] = round (L_shl (y32[i], j)); move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	159 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	160 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	161
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	162 /*************************************************************************
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	163 *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	164 * FUNCTION set_sign()
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	165 *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	166 * PURPOSE: Builds sign[] vector according to "dn[]" and "cn[]", and modifies
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	167 * dn[] to include the sign information (dn[i]=sign[i]*dn[i]).
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	168 * Also finds the position of maximum of correlation in each track
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	169 * and the starting position for each pulse.
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	170 *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	171 *************************************************************************/
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	172
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	173 void set_sign (
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	174 Word16 dn[], /* (i/o): correlation between target and h[] */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	175 Word16 cn[], /* (i) : residual after long term prediction */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	176 Word16 sign[], /* (o) : sign of d[n] */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	177 Word16 pos_max[], /* (o) : position of maximum correlation */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	178 Word16 ipos[] /* (o) : starting position for each pulse */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	179 )
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	180 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	181 Word16 i, j;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	182 Word16 val, cor, k_cn, k_dn, max, max_of_all, pos;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	183 Word16 en[L_CODE]; /* correlation vector */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	184 Word32 s;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	185
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	186 /* calculate energy for normalization of cn[] and dn[] */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	187
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	188 s = 256; move32 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	189 for (i = 0; i < L_CODE; i++)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	190 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	191 s = L_mac (s, cn[i], cn[i]);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	192 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	193 s = Inv_sqrt (s); move32 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	194 k_cn = extract_h (L_shl (s, 5));
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	195
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	196 s = 256; move32 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	197 for (i = 0; i < L_CODE; i++)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	198 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	199 s = L_mac (s, dn[i], dn[i]);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	200 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	201 s = Inv_sqrt (s); move32 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	202 k_dn = extract_h (L_shl (s, 5));
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	203
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	204 for (i = 0; i < L_CODE; i++)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	205 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	206 val = dn[i]; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	207 cor = round (L_shl (L_mac (L_mult (k_cn, cn[i]), k_dn, val), 10));
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	208
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	209 test ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	210 if (cor >= 0)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	211 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	212 sign[i] = 32767; move16 (); /* sign = +1 */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	213 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	214 else
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	215 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	216 sign[i] = -32767; move16 (); /* sign = -1 */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	217 cor = negate (cor);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	218 val = negate (val);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	219 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	220 /* modify dn[] according to the fixed sign */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	221 dn[i] = val; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	222 en[i] = cor; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	223 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	224
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	225 max_of_all = -1; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	226 for (i = 0; i < NB_TRACK; i++)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	227 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	228 max = -1; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	229
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	230 for (j = i; j < L_CODE; j += STEP)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	231 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	232 cor = en[j]; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	233 val = sub (cor, max);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	234 test ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	235 if (val > 0)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	236 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	237 max = cor; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	238 pos = j; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	239 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	240 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	241 /* store maximum correlation position */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	242 pos_max[i] = pos; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	243 val = sub (max, max_of_all);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	244 test ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	245 if (val > 0)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	246 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	247 max_of_all = max; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	248 /* starting position for i0 */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	249 ipos[0] = i; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	250 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	251 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	252
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	253 /----------------------------------------------------------------
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	254 * Set starting position of each pulse. *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	255 ----------------------------------------------------------------/
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	256
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	257 pos = ipos[0]; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	258 ipos[5] = pos; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	259
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	260 for (i = 1; i < NB_TRACK; i++)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	261 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	262 pos = add (pos, 1);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	263 if (sub (pos, NB_TRACK) >= 0)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	264 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	265 pos = 0; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	266 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	267 ipos[i] = pos; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	268 ipos[i + 5] = pos; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	269 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	270 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	271
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	272 void q_p (
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	273 Word16 ind, / Pulse position */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	274 Word16 n /* Pulse number */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	275 )
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	276 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	277 static const Word16 gray[8] = {0, 1, 3, 2, 6, 4, 5, 7};
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	278 Word16 tmp;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	279
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	280 tmp = *ind; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	281
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	282 test ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	283 if (sub (n, 5) < 0)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	284 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	285 tmp = (tmp & 0x8) \| gray[tmp & 0x7]; logic16 (); logic16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	286 logic16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	287 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	288 else
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	289 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	290 tmp = gray[tmp & 0x7]; logic16 (); move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	291 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	292
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	293 *ind = tmp; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	294 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	295
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	296 /*************************************************************************
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	297 *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	298 * FUNCTION: cor_h()
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	299 *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	300 * PURPOSE: Computes correlations of h[] needed for the codebook search;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	301 * and includes the sign information into the correlations.
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	302 *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	303 * DESCRIPTION: The correlations are given by
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	304 * rr[i][j] = sum_{n=i}^{L-1} h[n-i] h[n-j]; i>=j; i,j=0,...,L-1
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	305 *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	306 * and the sign information is included by
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	307 * rr[i][j] = rr[i][j]sign[i]sign[j]
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	308 *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	309 *************************************************************************/
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	310
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	311 void cor_h (
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	312 Word16 h[], /* (i) : impulse response of weighted synthesis
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	313 filter */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	314 Word16 sign[], /* (i) : sign of d[n] */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	315 Word16 rr[][L_CODE] /* (o) : matrix of autocorrelation */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	316 )
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	317 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	318 Word16 i, j, k, dec, h2[L_CODE];
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	319 Word32 s;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	320
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	321 /* Scaling for maximum precision */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	322
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	323 s = 2; move32 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	324 for (i = 0; i < L_CODE; i++)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	325 s = L_mac (s, h[i], h[i]);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	326
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	327 j = sub (extract_h (s), 32767);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	328 test ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	329 if (j == 0)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	330 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	331 for (i = 0; i < L_CODE; i++)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	332 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	333 h2[i] = shr (h[i], 1); move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	334 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	335 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	336 else
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	337 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	338 s = L_shr (s, 1);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	339 k = extract_h (L_shl (Inv_sqrt (s), 7));
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	340 k = mult (k, 32440); /* k = 0.99k /
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	341
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	342 for (i = 0; i < L_CODE; i++)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	343 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	344 h2[i] = round (L_shl (L_mult (h[i], k), 9));
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	345 move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	346 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	347 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	348
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	349 /* build matrix rr[] */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	350 s = 0; move32 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	351 i = L_CODE - 1;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	352 for (k = 0; k < L_CODE; k++, i--)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	353 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	354 s = L_mac (s, h2[k], h2[k]);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	355 rr[i][i] = round (s); move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	356 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	357
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	358 for (dec = 1; dec < L_CODE; dec++)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	359 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	360 s = 0; move32 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	361 j = L_CODE - 1;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	362 i = sub (j, dec);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	363 for (k = 0; k < (L_CODE - dec); k++, i--, j--)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	364 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	365 s = L_mac (s, h2[k], h2[k + dec]);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	366 rr[j][i] = mult (round (s), mult (sign[i], sign[j]));
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	367 move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	368 rr[i][j] = rr[j][i]; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	369 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	370 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	371 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	372
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	373 /*************************************************************************
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	374 *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	375 * FUNCTION search_10i40()
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	376 *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	377 * PURPOSE: Search the best codevector; determine positions of the 10 pulses
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	378 * in the 40-sample frame.
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	379 *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	380 *************************************************************************/
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	381
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	382 #define _1_2 (Word16)(32768L/2)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	383 #define _1_4 (Word16)(32768L/4)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	384 #define _1_8 (Word16)(32768L/8)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	385 #define _1_16 (Word16)(32768L/16)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	386 #define _1_32 (Word16)(32768L/32)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	387 #define _1_64 (Word16)(32768L/64)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	388 #define _1_128 (Word16)(32768L/128)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	389
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	390 void search_10i40 (
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	391 Word16 dn[], /* (i) : correlation between target and h[] */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	392 Word16 rr[][L_CODE], /* (i) : matrix of autocorrelation */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	393 Word16 ipos[], /* (i) : starting position for each pulse */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	394 Word16 pos_max[], /* (i) : position of maximum of dn[] */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	395 Word16 codvec[] /* (o) : algebraic codebook vector */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	396 )
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	397 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	398 Word16 i0, i1, i2, i3, i4, i5, i6, i7, i8, i9;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	399 Word16 i, j, k, pos, ia, ib;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	400 Word16 psk, ps, ps0, ps1, ps2, sq, sq2;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	401 Word16 alpk, alp, alp_16;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	402 Word16 rrv[L_CODE];
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	403 Word32 s, alp0, alp1, alp2;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	404
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	405 /* fix i0 on maximum of correlation position */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	406
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	407 i0 = pos_max[ipos[0]]; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	408
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	409 /------------------------------------------------------------------
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	410 * i1 loop: *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	411 ------------------------------------------------------------------/
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	412
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	413 /* Default value */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	414 psk = -1; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	415 alpk = 1; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	416 for (i = 0; i < NB_PULSE; i++)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	417 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	418 codvec[i] = i; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	419 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	420
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	421 for (i = 1; i < NB_TRACK; i++)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	422 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	423 i1 = pos_max[ipos[1]]; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	424 ps0 = add (dn[i0], dn[i1]);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	425 alp0 = L_mult (rr[i0][i0], _1_16);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	426 alp0 = L_mac (alp0, rr[i1][i1], _1_16);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	427 alp0 = L_mac (alp0, rr[i0][i1], _1_8);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	428
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	429 /----------------------------------------------------------------
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	430 * i2 and i3 loop: *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	431 ----------------------------------------------------------------/
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	432
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	433 /* initialize 4 indices for next loop. */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	434 move16 (); /* initialize "rr[i3][i3]" pointer */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	435 move16 (); /* initialize "rr[i0][i3]" pointer */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	436 move16 (); /* initialize "rr[i1][i3]" pointer */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	437 move16 (); /* initialize "rrv[i3]" pointer */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	438
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	439 for (i3 = ipos[3]; i3 < L_CODE; i3 += STEP)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	440 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	441 s = L_mult (rr[i3][i3], _1_8); /* index incr= STEP+L_CODE */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	442 s = L_mac (s, rr[i0][i3], _1_4); /* index increment = STEP */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	443 s = L_mac (s, rr[i1][i3], _1_4); /* index increment = STEP */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	444 rrv[i3] = round (s); move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	445 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	446
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	447 /* Default value */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	448 sq = -1; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	449 alp = 1; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	450 ps = 0; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	451 ia = ipos[2]; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	452 ib = ipos[3]; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	453
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	454 /* initialize 4 indices for i2 loop. */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	455 move16 (); /* initialize "dn[i2]" pointer */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	456 move16 (); /* initialize "rr[i2][i2]" pointer */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	457 move16 (); /* initialize "rr[i0][i2]" pointer */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	458 move16 (); /* initialize "rr[i1][i2]" pointer */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	459
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	460 for (i2 = ipos[2]; i2 < L_CODE; i2 += STEP)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	461 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	462 /* index increment = STEP */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	463 ps1 = add (ps0, dn[i2]);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	464
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	465 /* index incr= STEP+L_CODE */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	466 alp1 = L_mac (alp0, rr[i2][i2], _1_16);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	467 /* index increment = STEP */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	468 alp1 = L_mac (alp1, rr[i0][i2], _1_8);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	469 /* index increment = STEP */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	470 alp1 = L_mac (alp1, rr[i1][i2], _1_8);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	471
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	472 /* initialize 3 indices for i3 inner loop */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	473 move16 (); /* initialize "dn[i3]" pointer */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	474 move16 (); /* initialize "rrv[i3]" pointer */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	475 move16 (); /* initialize "rr[i2][i3]" pointer */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	476
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	477 for (i3 = ipos[3]; i3 < L_CODE; i3 += STEP)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	478 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	479 /* index increment = STEP */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	480 ps2 = add (ps1, dn[i3]);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	481
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	482 /* index increment = STEP */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	483 alp2 = L_mac (alp1, rrv[i3], _1_2);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	484 /* index increment = STEP */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	485 alp2 = L_mac (alp2, rr[i2][i3], _1_8);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	486
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	487 sq2 = mult (ps2, ps2);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	488
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	489 alp_16 = round (alp2);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	490
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	491 s = L_msu (L_mult (alp, sq2), sq, alp_16);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	492
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	493 test ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	494 if (s > 0)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	495 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	496 sq = sq2; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	497 ps = ps2; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	498 alp = alp_16; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	499 ia = i2; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	500 ib = i3; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	501 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	502 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	503 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	504 i2 = ia; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	505 i3 = ib; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	506
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	507 /----------------------------------------------------------------
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	508 * i4 and i5 loop: *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	509 ----------------------------------------------------------------/
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	510
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	511 ps0 = ps; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	512 alp0 = L_mult (alp, _1_2);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	513
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	514 /* initialize 6 indices for next loop (see i2-i3 loop) */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	515 move16 (); move16 (); move16 (); move16 (); move16 (); move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	516
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	517 for (i5 = ipos[5]; i5 < L_CODE; i5 += STEP)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	518 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	519 s = L_mult (rr[i5][i5], _1_8);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	520 s = L_mac (s, rr[i0][i5], _1_4);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	521 s = L_mac (s, rr[i1][i5], _1_4);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	522 s = L_mac (s, rr[i2][i5], _1_4);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	523 s = L_mac (s, rr[i3][i5], _1_4);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	524 rrv[i5] = round (s); move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	525 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	526
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	527 /* Default value */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	528 sq = -1; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	529 alp = 1; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	530 ps = 0; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	531 ia = ipos[4]; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	532 ib = ipos[5]; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	533
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	534 /* initialize 6 indices for i4 loop (see i2-i3 loop) */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	535 move16 (); move16 (); move16 (); move16 (); move16 (); move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	536
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	537 for (i4 = ipos[4]; i4 < L_CODE; i4 += STEP)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	538 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	539 ps1 = add (ps0, dn[i4]);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	540
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	541 alp1 = L_mac (alp0, rr[i4][i4], _1_32);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	542 alp1 = L_mac (alp1, rr[i0][i4], _1_16);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	543 alp1 = L_mac (alp1, rr[i1][i4], _1_16);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	544 alp1 = L_mac (alp1, rr[i2][i4], _1_16);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	545 alp1 = L_mac (alp1, rr[i3][i4], _1_16);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	546
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	547 /* initialize 3 indices for i5 inner loop (see i2-i3 loop) */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	548 move16 (); move16 (); move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	549
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	550 for (i5 = ipos[5]; i5 < L_CODE; i5 += STEP)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	551 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	552 ps2 = add (ps1, dn[i5]);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	553
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	554 alp2 = L_mac (alp1, rrv[i5], _1_4);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	555 alp2 = L_mac (alp2, rr[i4][i5], _1_16);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	556
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	557 sq2 = mult (ps2, ps2);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	558
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	559 alp_16 = round (alp2);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	560
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	561 s = L_msu (L_mult (alp, sq2), sq, alp_16);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	562
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	563 test ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	564 if (s > 0)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	565 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	566 sq = sq2; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	567 ps = ps2; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	568 alp = alp_16; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	569 ia = i4; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	570 ib = i5; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	571 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	572 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	573 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	574 i4 = ia; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	575 i5 = ib; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	576
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	577 /----------------------------------------------------------------
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	578 * i6 and i7 loop: *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	579 ----------------------------------------------------------------/
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	580
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	581 ps0 = ps; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	582 alp0 = L_mult (alp, _1_2);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	583
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	584 /* initialize 8 indices for next loop (see i2-i3 loop) */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	585 move16 (); move16 (); move16 (); move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	586 move16 (); move16 (); move16 (); move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	587
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	588 for (i7 = ipos[7]; i7 < L_CODE; i7 += STEP)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	589 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	590 s = L_mult (rr[i7][i7], _1_16);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	591 s = L_mac (s, rr[i0][i7], _1_8);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	592 s = L_mac (s, rr[i1][i7], _1_8);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	593 s = L_mac (s, rr[i2][i7], _1_8);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	594 s = L_mac (s, rr[i3][i7], _1_8);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	595 s = L_mac (s, rr[i4][i7], _1_8);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	596 s = L_mac (s, rr[i5][i7], _1_8);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	597 rrv[i7] = round (s); move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	598 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	599
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	600 /* Default value */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	601 sq = -1; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	602 alp = 1; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	603 ps = 0; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	604 ia = ipos[6]; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	605 ib = ipos[7]; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	606
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	607 /* initialize 8 indices for i6 loop (see i2-i3 loop) */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	608 move16 (); move16 (); move16 (); move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	609 move16 (); move16 (); move16 (); move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	610
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	611 for (i6 = ipos[6]; i6 < L_CODE; i6 += STEP)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	612 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	613 ps1 = add (ps0, dn[i6]);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	614
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	615 alp1 = L_mac (alp0, rr[i6][i6], _1_64);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	616 alp1 = L_mac (alp1, rr[i0][i6], _1_32);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	617 alp1 = L_mac (alp1, rr[i1][i6], _1_32);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	618 alp1 = L_mac (alp1, rr[i2][i6], _1_32);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	619 alp1 = L_mac (alp1, rr[i3][i6], _1_32);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	620 alp1 = L_mac (alp1, rr[i4][i6], _1_32);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	621 alp1 = L_mac (alp1, rr[i5][i6], _1_32);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	622
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	623 /* initialize 3 indices for i7 inner loop (see i2-i3 loop) */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	624 move16 (); move16 (); move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	625
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	626 for (i7 = ipos[7]; i7 < L_CODE; i7 += STEP)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	627 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	628 ps2 = add (ps1, dn[i7]);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	629
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	630 alp2 = L_mac (alp1, rrv[i7], _1_4);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	631 alp2 = L_mac (alp2, rr[i6][i7], _1_32);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	632
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	633 sq2 = mult (ps2, ps2);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	634
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	635 alp_16 = round (alp2);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	636
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	637 s = L_msu (L_mult (alp, sq2), sq, alp_16);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	638
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	639 test ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	640 if (s > 0)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	641 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	642 sq = sq2; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	643 ps = ps2; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	644 alp = alp_16; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	645 ia = i6; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	646 ib = i7; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	647 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	648 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	649 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	650 i6 = ia; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	651 i7 = ib; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	652
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	653 /----------------------------------------------------------------
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	654 * i8 and i9 loop: *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	655 ----------------------------------------------------------------/
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	656
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	657 ps0 = ps; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	658 alp0 = L_mult (alp, _1_2);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	659
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	660 /* initialize 10 indices for next loop (see i2-i3 loop) */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	661 move16 (); move16 (); move16 (); move16 (); move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	662 move16 (); move16 (); move16 (); move16 (); move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	663
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	664 for (i9 = ipos[9]; i9 < L_CODE; i9 += STEP)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	665 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	666 s = L_mult (rr[i9][i9], _1_16);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	667 s = L_mac (s, rr[i0][i9], _1_8);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	668 s = L_mac (s, rr[i1][i9], _1_8);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	669 s = L_mac (s, rr[i2][i9], _1_8);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	670 s = L_mac (s, rr[i3][i9], _1_8);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	671 s = L_mac (s, rr[i4][i9], _1_8);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	672 s = L_mac (s, rr[i5][i9], _1_8);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	673 s = L_mac (s, rr[i6][i9], _1_8);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	674 s = L_mac (s, rr[i7][i9], _1_8);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	675 rrv[i9] = round (s); move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	676 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	677
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	678 /* Default value */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	679 sq = -1; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	680 alp = 1; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	681 ps = 0; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	682 ia = ipos[8]; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	683 ib = ipos[9]; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	684
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	685 /* initialize 10 indices for i8 loop (see i2-i3 loop) */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	686 move16 (); move16 (); move16 (); move16 (); move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	687 move16 (); move16 (); move16 (); move16 (); move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	688
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	689 for (i8 = ipos[8]; i8 < L_CODE; i8 += STEP)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	690 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	691 ps1 = add (ps0, dn[i8]);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	692
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	693 alp1 = L_mac (alp0, rr[i8][i8], _1_128);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	694 alp1 = L_mac (alp1, rr[i0][i8], _1_64);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	695 alp1 = L_mac (alp1, rr[i1][i8], _1_64);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	696 alp1 = L_mac (alp1, rr[i2][i8], _1_64);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	697 alp1 = L_mac (alp1, rr[i3][i8], _1_64);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	698 alp1 = L_mac (alp1, rr[i4][i8], _1_64);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	699 alp1 = L_mac (alp1, rr[i5][i8], _1_64);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	700 alp1 = L_mac (alp1, rr[i6][i8], _1_64);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	701 alp1 = L_mac (alp1, rr[i7][i8], _1_64);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	702
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	703 /* initialize 3 indices for i9 inner loop (see i2-i3 loop) */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	704 move16 (); move16 (); move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	705
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	706 for (i9 = ipos[9]; i9 < L_CODE; i9 += STEP)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	707 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	708 ps2 = add (ps1, dn[i9]);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	709
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	710 alp2 = L_mac (alp1, rrv[i9], _1_8);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	711 alp2 = L_mac (alp2, rr[i8][i9], _1_64);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	712
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	713 sq2 = mult (ps2, ps2);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	714
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	715 alp_16 = round (alp2);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	716
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	717 s = L_msu (L_mult (alp, sq2), sq, alp_16);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	718
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	719 test ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	720 if (s > 0)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	721 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	722 sq = sq2; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	723 ps = ps2; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	724 alp = alp_16; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	725 ia = i8; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	726 ib = i9; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	727 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	728 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	729 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	730
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	731 /----------------------------------------------------------------
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	732 * memorise codevector if this one is better than the last one. *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	733 ----------------------------------------------------------------/
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	734
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	735 s = L_msu (L_mult (alpk, sq), psk, alp);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	736
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	737 test ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	738 if (s > 0)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	739 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	740 psk = sq; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	741 alpk = alp; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	742 codvec[0] = i0; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	743 codvec[1] = i1; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	744 codvec[2] = i2; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	745 codvec[3] = i3; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	746 codvec[4] = i4; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	747 codvec[5] = i5; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	748 codvec[6] = i6; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	749 codvec[7] = i7; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	750 codvec[8] = ia; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	751 codvec[9] = ib; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	752 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	753 /----------------------------------------------------------------
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	754 * Cyclic permutation of i1,i2,i3,i4,i5,i6,i7,i8 and i9. *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	755 ----------------------------------------------------------------/
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	756
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	757 pos = ipos[1]; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	758 for (j = 1, k = 2; k < NB_PULSE; j++, k++)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	759 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	760 ipos[j] = ipos[k]; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	761 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	762 ipos[NB_PULSE - 1] = pos; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	763 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	764 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	765
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	766 /*************************************************************************
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	767 *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	768 * FUNCTION: build_code()
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	769 *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	770 * PURPOSE: Builds the codeword, the filtered codeword and index of the
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	771 * codevector, based on the signs and positions of 10 pulses.
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	772 *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	773 *************************************************************************/
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	774
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	775 void build_code (
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	776 Word16 codvec[], /* (i) : position of pulses */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	777 Word16 sign[], /* (i) : sign of d[n] */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	778 Word16 cod[], /* (o) : innovative code vector */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	779 Word16 h[], /* (i) : impulse response of weighted synthesis filter*/
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	780 Word16 y[], /* (o) : filtered innovative code */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	781 Word16 indx[] /* (o) : index of 10 pulses (sign+position) */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	782 )
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	783 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	784 Word16 i, j, k, track, index, _sign[NB_PULSE];
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	785 Word16 p0, p1, p2, p3, p4, p5, p6, p7, p8, p9;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	786 Word32 s;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	787
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	788 for (i = 0; i < L_CODE; i++)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	789 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	790 cod[i] = 0; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	791 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	792 for (i = 0; i < NB_TRACK; i++)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	793 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	794 indx[i] = -1; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	795 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	796
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	797 for (k = 0; k < NB_PULSE; k++)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	798 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	799 /* read pulse position */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	800 i = codvec[k]; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	801 /* read sign */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	802 j = sign[i]; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	803
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	804 index = mult (i, 6554); /* index = pos/5 */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	805 /* track = pos%5 */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	806 track = sub (i, extract_l (L_shr (L_mult (index, 5), 1)));
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	807 test ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	808 if (j > 0)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	809 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	810 cod[i] = add (cod[i], 4096);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	811 _sign[k] = 8192; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	812
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	813 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	814 else
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	815 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	816 cod[i] = sub (cod[i], 4096);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	817 _sign[k] = -8192; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	818 index = add (index, 8);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	819 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	820
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	821 test ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	822 if (indx[track] < 0)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	823 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	824 indx[track] = index; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	825 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	826 else
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	827 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	828 test (); logic16 (); logic16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	829 if (((index ^ indx[track]) & 8) == 0)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	830 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	831 /* sign of 1st pulse == sign of 2nd pulse */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	832
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	833 test ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	834 if (sub (indx[track], index) <= 0)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	835 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	836 indx[track + 5] = index; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	837 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	838 else
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	839 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	840 indx[track + 5] = indx[track];
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	841 move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	842 indx[track] = index; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	843 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	844 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	845 else
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	846 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	847 /* sign of 1st pulse != sign of 2nd pulse */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	848
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	849 test (); logic16 (); logic16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	850 if (sub ((indx[track] & 7), (index & 7)) <= 0)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	851 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	852 indx[track + 5] = indx[track];
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	853 move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	854 indx[track] = index; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	855 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	856 else
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	857 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	858 indx[track + 5] = index; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	859 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	860 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	861 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	862 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	863
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	864 p0 = h - codvec[0]; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	865 p1 = h - codvec[1]; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	866 p2 = h - codvec[2]; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	867 p3 = h - codvec[3]; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	868 p4 = h - codvec[4]; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	869 p5 = h - codvec[5]; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	870 p6 = h - codvec[6]; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	871 p7 = h - codvec[7]; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	872 p8 = h - codvec[8]; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	873 p9 = h - codvec[9]; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	874
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	875 for (i = 0; i < L_CODE; i++)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	876 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	877 s = 0; move32 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	878 s = L_mac (s, *p0++, _sign[0]);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	879 s = L_mac (s, *p1++, _sign[1]);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	880 s = L_mac (s, *p2++, _sign[2]);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	881 s = L_mac (s, *p3++, _sign[3]);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	882 s = L_mac (s, *p4++, _sign[4]);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	883 s = L_mac (s, *p5++, _sign[5]);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	884 s = L_mac (s, *p6++, _sign[6]);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	885 s = L_mac (s, *p7++, _sign[7]);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	886 s = L_mac (s, *p8++, _sign[8]);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	887 s = L_mac (s, *p9++, _sign[9]);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	888 y[i] = round (s); move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	889 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	890 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	891

FreeCalypso > hg > efr-experiments

annotate src/c1035pf.c @ 8:8b17df8f6340 default tip