s10_8pf.cpp revision b841f14f8e51f2365945281fbfa54ef6a1b1b5a6
1b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/* ------------------------------------------------------------------
2b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * Copyright (C) 1998-2009 PacketVideo
3b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *
4b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * Licensed under the Apache License, Version 2.0 (the "License");
5b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * you may not use this file except in compliance with the License.
6b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * You may obtain a copy of the License at
7b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *
8b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *      http://www.apache.org/licenses/LICENSE-2.0
9b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *
10b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * Unless required by applicable law or agreed to in writing, software
11b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * distributed under the License is distributed on an "AS IS" BASIS,
12b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either
13b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * express or implied.
14b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * See the License for the specific language governing permissions
15b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * and limitations under the License.
16b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * -------------------------------------------------------------------
17b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber */
18b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/****************************************************************************************
19b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas HuberPortions of this file are derived from the following 3GPP standard:
20b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
21b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    3GPP TS 26.073
22b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    ANSI-C code for the Adaptive Multi-Rate (AMR) speech codec
23b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    Available from http://www.3gpp.org
24b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
25b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber(C) 2004, 3GPP Organizational Partners (ARIB, ATIS, CCSA, ETSI, TTA, TTC)
26b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas HuberPermission to distribute, modify and use this file under the standard license
27b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huberterms listed above has been obtained from the copyright holder.
28b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber****************************************************************************************/
29b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*
30b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------
31b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
32b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
33b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
34b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Pathname: ./audio/gsm-amr/c/src/s10_8pf.c
35b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Funtions: search_10and8i40
36b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
37b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber     Date: 04/18/2000
38b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
39b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------
40b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REVISION HISTORY
41b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
42b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Adding pOverflow to the functions to remove global variables.
43b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber              These changes are needed for the EPOC releases. Cleaned up code.
44b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber              Updated template.
45b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
46b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Changed temp to temp32. When temp was only 16 bits it was not
47b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber              holding the 32 bit value returned from the functions. Some
48b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber              variables were also being declared as Word16 rather than Word32
49b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber              as they were suposed to be.
50b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
51b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Changed copyright year. Removed all calls to math functions by
52b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber              inlining them, and removed all unnecessary files in the Include
53b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber              section.
54b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
55b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Made the following changes per comments from Phase 2/3 review:
56b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber              1. Removed all #defines.
57b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber              2. Used a pointer to &codvec[0] instead of array indexing.
58b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber              3. Removed multiple data casting in the code.
59b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
60b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description:
61b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber              1. Eliminated unused include files.
62b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber              2. Replaced array addressing by pointers, this by taking
63b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                 advantage of the fact that the autocrrelation  matrix is
64b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                 a toeplitz matrix, so r[i][j] = r[j][i], then a single
65b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                 pointer can be used to address a matrix. The use of this
66b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                 is not uniform along the function (due to compiler limitations:
67b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                 handling so many variables in this file) so the use
68b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                 of this is pointer optimizations is limited to places
69b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                 where the ARM compiler provides the lesses numer of cycles
70b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber              3. Eliminated use of intermediate variables to accelerate
71b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                 comparisons (like in the nested loops)
72b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber              4. Introduced array temp1[], to pre-calculate the elements
73b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                 used in the nested loops, in this way the calculation is
74b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                 not repeated in every loop iteration. This is done for
75b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                 loops i3-i5-i7 and i9
76b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber              5. Use array Index[] to store indexes i1:i9, and then use memcpy
77b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                 to update indexes.
78b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber              6. Eliminated shifts by modifying the way number are rounded,
79b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                 this does not have any effect in ARM processors but may help
80b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                 other compilers
81b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
82b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description:
83b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber              1. When storing indexes, added memcpy() to support the rates
84b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                 that use this function: 12.2 (already done) and 10.2 (missing).
85b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
86b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description:  Replaced OSCL mem type functions and eliminated include
87b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber               files that now are chosen by OSCL definitions
88b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
89b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Changed round function name to pv_round to avoid conflict with
90b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber              round function in C standard library.
91b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
92b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description:
93b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
94b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------
95b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber*/
96b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
97b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*----------------------------------------------------------------------------
98b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; INCLUDES
99b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/
100b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include <string.h>
101b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
102b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "s10_8pf.h"
103b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "cnst.h"
104b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
105b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*----------------------------------------------------------------------------
106b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; MACROS
107b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; Define module specific macros here
108b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/
109b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
110b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*----------------------------------------------------------------------------
111b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; DEFINES
112b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; Include all pre-processor statements here. Include conditional
113b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; compile variables also.
114b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/
115b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
116b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*----------------------------------------------------------------------------
117b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; LOCAL FUNCTION DEFINITIONS
118b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; Function Prototype declaration
119b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/
120b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
121b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*----------------------------------------------------------------------------
122b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; LOCAL VARIABLE DEFINITIONS
123b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; Variable declaration - defined here and used outside this module
124b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/
125b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
126b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*
127b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------
128b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION NAME: search_10and8i40
129b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------
130b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber INPUT AND OUTPUT DEFINITIONS
131b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
132b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Inputs:
133b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    nbPulse = nbPulses to find (Word16)
134b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    step = step size (Word16)
135b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    nbTracks = nbTracks (Word16)
136b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    dn[] = correlation between target and h[] (Word16)
137b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    rr[][] = matrix of autocorrelation (Word16)
138b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    ipos[] = starting position of each pulse (Word16)
139b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    pos_max[] = Position of maximum dn[] (Word16)
140b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    codvec[] = Algebraic codebook vector (Word16)
141b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    pOverflow = pointer to Overflow flag (Flag)
142b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
143b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Outputs:
144b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    codvec[] = Algebraic codebook vector (Word16)
145b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    pOverflow -> 1 if processing this funvction results in satuaration
146b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
147b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Returns:
148b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    None
149b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
150b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Global Variables Used:
151b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    None
152b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
153b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Local Variables Needed:
154b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    None
155b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
156b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------
157b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION DESCRIPTION
158b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
159b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber This function searches for the best codevector; It determines the positions
160b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber of the 10/8 pulses in the 40-sample frame.
161b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
162b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    search_10and8i40 (10,5,5,dn, rr, ipos, pos_max, codvec);   for GSMEFR
163b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    search_10and8i40 (8, 4,4,dn, rr, ipos, pos_max, codvec);   for 10.2
164b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
165b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
166b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------
167b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REQUIREMENTS
168b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
169b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None
170b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
171b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------
172b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REFERENCES
173b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
174b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s10_8pf.c, UMTS GSM AMR speech codec, R99 - Version 3.2.0, March 2, 2001
175b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
176b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------
177b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber PSEUDO-CODE
178b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
179b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Hubervoid search_10and8i40 (
180b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    Word16 nbPulse,      // i : nbpulses to find
181b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    Word16 step,         // i :  stepsize
182b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    Word16 nbTracks,     // i :  nbTracks
183b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    Word16 dn[],         // i : correlation between target and h[]
184b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    Word16 rr[][L_CODE], // i : matrix of autocorrelation
185b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    Word16 ipos[],       // i : starting position for each pulse
186b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    Word16 pos_max[],    // i : position of maximum of dn[]
187b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    Word16 codvec[]      // o : algebraic codebook vector
188b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber)
189b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{
190b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber   Word16 i0, i1, i2, i3, i4, i5, i6, i7, i8, i9;
191b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber   Word16 i, j, k, pos, ia, ib;
192b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber   Word16 psk, ps, ps0, ps1, ps2, sq, sq2;
193b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber   Word16 alpk, alp, alp_16;
194b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber   Word16 rrv[L_CODE];
195b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber   Word32 s, alp0, alp1, alp2;
196b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber   Word16 gsmefrFlag;
197b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
198b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
199b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber   if (sub(nbPulse, 10) == 0)
200b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber   {
201b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber      gsmefrFlag=1;
202b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber   }
203b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber   else
204b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber   {
205b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber      gsmefrFlag=0;
206b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber   }
207b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
208b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber   // fix i0 on maximum of correlation position
209b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber   i0 = pos_max[ipos[0]];
210b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
211b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber   //
212b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber   // i1 loop:                                                         *
213b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber   //
214b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
215b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber   // Default value
216b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
217b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber   psk = -1;
218b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber   alpk = 1;
219b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber   for (i = 0; i < nbPulse; i++)
220b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber   {
221b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber      codvec[i] = i;
222b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber   }
223b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
224b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber   for (i = 1; i < nbTracks; i++)
225b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber   {
226b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber      i1 = pos_max[ipos[1]];
227b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber      ps0 = add (dn[i0], dn[i1]);
228b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber      alp0 = L_mult (rr[i0][i0], _1_16);
229b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber      alp0 = L_mac (alp0, rr[i1][i1], _1_16);
230b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber      alp0 = L_mac (alp0, rr[i0][i1], _1_8);
231b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
232b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber      //
233b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber      // i2 and i3 loop
234b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber      //
235b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
236b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber      for (i3 = ipos[3]; i3 < L_CODE; i3 += step)
237b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber      {
238b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber         s = L_mult (rr[i3][i3], _1_8);       // index incr= step+L_CODE
239b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber         s = L_mac (s, rr[i0][i3], _1_4);     // index increment = step
240b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber         s = L_mac (s, rr[i1][i3], _1_4);     // index increment = step
241b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber         rrv[i3] = pv_round (s);
242b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber      }
243b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
244b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber      // Default value
245b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber      sq = -1;
246b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber      alp = 1;
247b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber      ps = 0;
248b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber      ia = ipos[2];
249b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber      ib = ipos[3];
250b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
251b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber      for (i2 = ipos[2]; i2 < L_CODE; i2 += step)
252b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber      {
253b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber         // index increment = step
254b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber         ps1 = add (ps0, dn[i2]);
255b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
256b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber         // index incr= step+L_CODE
257b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber         alp1 = L_mac (alp0, rr[i2][i2], _1_16);
258b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
259b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber         // index increment = step
260b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber         alp1 = L_mac (alp1, rr[i0][i2], _1_8);
261b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
262b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber         // index increment = step
263b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber         alp1 = L_mac (alp1, rr[i1][i2], _1_8);
264b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
265b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber         for (i3 = ipos[3]; i3 < L_CODE; i3 += step)
266b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber         {
267b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            // index increment = step
268b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            ps2 = add (ps1, dn[i3]);
269b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
270b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            // index increment = step
271b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            alp2 = L_mac (alp1, rrv[i3], _1_2);
272b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
273b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            // index increment = step
274b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            alp2 = L_mac (alp2, rr[i2][i3], _1_8);
275b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
276b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            sq2 = mult (ps2, ps2);
277b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
278b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            alp_16 = pv_round (alp2);
279b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
280b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            s = L_msu (L_mult (alp, sq2), sq, alp_16);
281b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
282b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            if (s > 0)
283b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            {
284b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber               sq = sq2;
285b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber               ps = ps2;
286b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber               alp = alp_16;
287b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber               ia = i2;
288b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber               ib = i3;
289b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            }
290b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber         }
291b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber      }
292b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber      i2 = ia;
293b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber      i3 = ib;
294b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
295b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        //
296b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        // i4 and i5 loop:
297b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        //
298b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
299b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        ps0 = ps;
300b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        alp0 = L_mult (alp, _1_2);
301b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
302b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        for (i5 = ipos[5]; i5 < L_CODE; i5 += step)
303b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        {
304b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            s = L_mult (rr[i5][i5], _1_8);
305b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            s = L_mac (s, rr[i0][i5], _1_4);
306b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            s = L_mac (s, rr[i1][i5], _1_4);
307b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            s = L_mac (s, rr[i2][i5], _1_4);
308b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            s = L_mac (s, rr[i3][i5], _1_4);
309b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            rrv[i5] = pv_round (s);
310b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        }
311b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
312b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        // Default value
313b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        sq = -1;
314b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        alp = 1;
315b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        ps = 0;
316b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        ia = ipos[4];
317b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        ib = ipos[5];
318b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
319b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        for (i4 = ipos[4]; i4 < L_CODE; i4 += step)
320b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        {
321b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            ps1 = add (ps0, dn[i4]);
322b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
323b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            alp1 = L_mac (alp0, rr[i4][i4], _1_32);
324b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            alp1 = L_mac (alp1, rr[i0][i4], _1_16);
325b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            alp1 = L_mac (alp1, rr[i1][i4], _1_16);
326b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            alp1 = L_mac (alp1, rr[i2][i4], _1_16);
327b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            alp1 = L_mac (alp1, rr[i3][i4], _1_16);
328b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
329b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            for (i5 = ipos[5]; i5 < L_CODE; i5 += step)
330b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            {
331b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                ps2 = add (ps1, dn[i5]);
332b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
333b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                alp2 = L_mac (alp1, rrv[i5], _1_4);
334b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                alp2 = L_mac (alp2, rr[i4][i5], _1_16);
335b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
336b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                sq2 = mult (ps2, ps2);
337b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
338b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                alp_16 = pv_round (alp2);
339b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
340b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                s = L_msu (L_mult (alp, sq2), sq, alp_16);
341b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
342b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                if (s > 0)
343b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                {
344b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                    sq = sq2;
345b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                    ps = ps2;
346b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                    alp = alp_16;
347b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                    ia = i4;
348b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                    ib = i5;
349b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                }
350b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            }
351b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        }
352b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        i4 = ia;
353b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        i5 = ib;
354b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
355b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        //
356b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        // i6 and i7 loop:
357b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        //
358b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
359b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        ps0 = ps;
360b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        alp0 = L_mult (alp, _1_2);
361b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
362b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        for (i7 = ipos[7]; i7 < L_CODE; i7 += step)
363b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        {
364b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            s = L_mult (rr[i7][i7], _1_16);
365b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            s = L_mac (s, rr[i0][i7], _1_8);
366b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            s = L_mac (s, rr[i1][i7], _1_8);
367b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            s = L_mac (s, rr[i2][i7], _1_8);
368b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            s = L_mac (s, rr[i3][i7], _1_8);
369b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            s = L_mac (s, rr[i4][i7], _1_8);
370b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            s = L_mac (s, rr[i5][i7], _1_8);
371b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            rrv[i7] = pv_round (s);
372b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        }
373b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
374b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        // Default value
375b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        sq = -1;
376b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        alp = 1;
377b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        ps = 0;
378b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        ia = ipos[6];
379b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        ib = ipos[7];
380b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
381b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        for (i6 = ipos[6]; i6 < L_CODE; i6 += step)
382b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        {
383b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            ps1 = add (ps0, dn[i6]);
384b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
385b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            alp1 = L_mac (alp0, rr[i6][i6], _1_64);
386b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            alp1 = L_mac (alp1, rr[i0][i6], _1_32);
387b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            alp1 = L_mac (alp1, rr[i1][i6], _1_32);
388b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            alp1 = L_mac (alp1, rr[i2][i6], _1_32);
389b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            alp1 = L_mac (alp1, rr[i3][i6], _1_32);
390b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            alp1 = L_mac (alp1, rr[i4][i6], _1_32);
391b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            alp1 = L_mac (alp1, rr[i5][i6], _1_32);
392b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
393b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            for (i7 = ipos[7]; i7 < L_CODE; i7 += step)
394b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            {
395b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                ps2 = add (ps1, dn[i7]);
396b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
397b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                alp2 = L_mac (alp1, rrv[i7], _1_4);
398b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                alp2 = L_mac (alp2, rr[i6][i7], _1_32);
399b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
400b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                sq2 = mult (ps2, ps2);
401b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
402b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                alp_16 = pv_round (alp2);
403b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
404b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                s = L_msu (L_mult (alp, sq2), sq, alp_16);
405b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
406b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                if (s > 0)
407b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                {
408b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                    sq = sq2;
409b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                    ps = ps2;
410b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                    alp = alp_16;
411b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                    ia = i6;
412b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                    ib = i7;
413b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                }
414b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            }
415b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        }
416b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        i6 = ia;
417b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        i7 = ib;
418b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
419b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        // now finished searching a set of 8 pulses
420b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
421b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        if(gsmefrFlag != 0){
422b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber           // go on with the two last pulses for GSMEFR
423b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber           //
424b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber           // i8 and i9 loop:
425b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber           //
426b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
427b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber           ps0 = ps;
428b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber           alp0 = L_mult (alp, _1_2);
429b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
430b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber           for (i9 = ipos[9]; i9 < L_CODE; i9 += step)
431b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber           {
432b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber              s = L_mult (rr[i9][i9], _1_16);
433b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber              s = L_mac (s, rr[i0][i9], _1_8);
434b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber              s = L_mac (s, rr[i1][i9], _1_8);
435b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber              s = L_mac (s, rr[i2][i9], _1_8);
436b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber              s = L_mac (s, rr[i3][i9], _1_8);
437b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber              s = L_mac (s, rr[i4][i9], _1_8);
438b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber              s = L_mac (s, rr[i5][i9], _1_8);
439b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber              s = L_mac (s, rr[i6][i9], _1_8);
440b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber              s = L_mac (s, rr[i7][i9], _1_8);
441b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber              rrv[i9] = pv_round (s);
442b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber           }
443b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
444b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber           // Default value
445b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber           sq = -1;
446b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber           alp = 1;
447b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber           ps = 0;
448b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber           ia = ipos[8];
449b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber           ib = ipos[9];
450b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
451b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber           for (i8 = ipos[8]; i8 < L_CODE; i8 += step)
452b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber           {
453b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber              ps1 = add (ps0, dn[i8]);
454b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
455b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber              alp1 = L_mac (alp0, rr[i8][i8], _1_128);
456b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber              alp1 = L_mac (alp1, rr[i0][i8], _1_64);
457b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber              alp1 = L_mac (alp1, rr[i1][i8], _1_64);
458b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber              alp1 = L_mac (alp1, rr[i2][i8], _1_64);
459b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber              alp1 = L_mac (alp1, rr[i3][i8], _1_64);
460b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber              alp1 = L_mac (alp1, rr[i4][i8], _1_64);
461b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber              alp1 = L_mac (alp1, rr[i5][i8], _1_64);
462b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber              alp1 = L_mac (alp1, rr[i6][i8], _1_64);
463b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber              alp1 = L_mac (alp1, rr[i7][i8], _1_64);
464b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
465b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber              for (i9 = ipos[9]; i9 < L_CODE; i9 += step)
466b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber              {
467b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                 ps2 = add (ps1, dn[i9]);
468b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
469b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                 alp2 = L_mac (alp1, rrv[i9], _1_8);
470b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                 alp2 = L_mac (alp2, rr[i8][i9], _1_64);
471b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
472b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                 sq2 = mult (ps2, ps2);
473b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
474b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                 alp_16 = pv_round (alp2);
475b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
476b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                 s = L_msu (L_mult (alp, sq2), sq, alp_16);
477b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
478b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                 if (s > 0)
479b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                 {
480b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                    sq = sq2;
481b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                    ps = ps2;
482b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                    alp = alp_16;
483b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                    ia = i8;
484b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                    ib = i9;
485b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                 }
486b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber              }
487b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber           }
488b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        } // end  gsmefrFlag
489b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
490b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        //
491b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        // test and memorise if this combination is better than the last one/
492b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        //
493b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
494b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        s = L_msu (L_mult (alpk, sq), psk, alp);
495b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
496b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        if (s > 0)
497b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        {
498b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            psk = sq;
499b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            alpk = alp;
500b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            codvec[0] = i0;
501b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            codvec[1] = i1;
502b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            codvec[2] = i2;
503b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            codvec[3] = i3;
504b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            codvec[4] = i4;
505b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            codvec[5] = i5;
506b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            codvec[6] = i6;
507b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            codvec[7] = i7;
508b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
509b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            if (gsmefrFlag != 0)
510b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            {
511b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber               codvec[8] = ia;
512b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber               codvec[9] = ib;
513b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            }
514b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        }
515b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
516b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        //
517b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        // Cyclic permutation of i1,i2,i3,i4,i5,i6,i7,(i8 and i9)/
518b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        //
519b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
520b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        pos = ipos[1];
521b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        for (j = 1, k = 2; k < nbPulse; j++, k++)
522b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        {
523b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            ipos[j] = ipos[k];
524b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        }
525b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        ipos[sub(nbPulse,1)] = pos;
526b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber   } // end 1..nbTracks  loop
527b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber}
528b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
529b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------
530b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber RESOURCES USED [optional]
531b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
532b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber When the code is written for a specific target processor the
533b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber the resources used should be documented below.
534b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
535b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber HEAP MEMORY USED: x bytes
536b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
537b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber STACK MEMORY USED: x bytes
538b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
539b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CLOCK CYCLES: (cycle count equation for this function) + (variable
540b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                used to represent cycle count for each subroutine
541b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                called)
542b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber     where: (cycle count variable) = cycle count for [subroutine
543b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                                     name]
544b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
545b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------
546b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CAUTION [optional]
547b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber [State any special notes, constraints or cautions for users of this function]
548b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
549b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------
550b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber*/
551b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
552b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
553b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*----------------------------------------------------------------------------
554b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; FUNCTION CODE
555b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/
556b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Hubervoid search_10and8i40(
557b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    Word16 nbPulse,      /* i : nbpulses to find                       */
558b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    Word16 step,         /* i : stepsize                               */
559b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    Word16 nbTracks,     /* i : nbTracks                               */
560b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    Word16 dn[],         /* i : correlation between target and h[]     */
561b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    Word16 rr[][L_CODE], /* i : matrix of autocorrelation              */
562b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    Word16 ipos[],       /* i : starting position for each pulse       */
563b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    Word16 pos_max[],    /* i : position of maximum of dn[]            */
564b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    Word16 codvec[],     /* o : algebraic codebook vector              */
565b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    Flag   *pOverflow    /* i/o : overflow flag                        */
566b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber)
567b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{
568b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    Word16 i0, i1, i2, i3, i4, i5, i6, i7, i9;
569b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    Word16 i, j, k/*, m*/;
570b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    Word16 pos, ia, ib;
571b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    Word16 psk;
572b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    Word16 sq, sq2;
573b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    Word16 alpk, alp, alp_16;
574b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    Word32 s;
575b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    Word32 alp0, alp1, alp2;
576b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    Word16 gsmefrFlag;
577b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    Word16 *p_codvec = codvec;
578b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    Word16  *p_temp2;
579b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
580b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    Word16  temp1[2*L_CODE];
581b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    Word16  *p_temp1;
582b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    Word16  ps2;
583b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    Word16  ps1;
584b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    Word16  ps;
585b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    Word16 ps0;
586b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
587b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    Word16  index[10];
588b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
589b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    OSCL_UNUSED_ARG(pOverflow);
590b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
591b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    if (nbPulse == 10)
592b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    {
593b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        gsmefrFlag = 1;
594b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    }
595b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    else
596b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    {
597b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        gsmefrFlag = 0;
598b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    }
599b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
600b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    /* fix i0 on maximum of correlation position */
601b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    i0 = pos_max[ipos[0]];
602b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    index[0] = i0;
603b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    /*------------------------------------------------------------------*
604b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    * i1 loop:                                                         *
605b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    *------------------------------------------------------------------*/
606b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
607b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    /* Default value */
608b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    psk = -1;
609b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    alpk = 1;
610b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    for (i = 0; i < nbPulse; i++)
611b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    {
612b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        *(p_codvec++) = i;
613b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    }
614b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
615b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    for (i = 1; i < nbTracks; i++)
616b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    {
617b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        i1 = pos_max[ipos[1]];
618b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        index[1] = i1;
619b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
620b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        /* ps0 = add (dn[i0], dn[i1], pOverflow);*/
621b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        ps0 = (Word16)((Word32) dn[i0] + dn[i1]);
622b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
623b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        /* alp0 = L_mult (rr[i0][i0], _1_16, pOverflow); */
624b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        alp0 = (Word32) rr[i0][i0] << 12;
625b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
626b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        /* alp0 = L_mac (alp0, rr[i1][i1], _1_16, pOverflow); */
627b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        alp0 += (Word32) rr[i1][i1] << 12;
628b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
629b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        /* alp0 = L_mac (alp0, rr[i0][i1], _1_8, pOverflow); */
630b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        alp0 += (Word32) rr[i0][i1] << 13;
631b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        alp0 += 0x00008000L;
632b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
633b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        /*----------------------------------------------------------------*
634b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        * i2 and i3 loop:                                                *
635b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        *----------------------------------------------------------------*/
636b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
637b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        p_temp1 = temp1;
638b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        for (i3 = ipos[3]; i3 < L_CODE; i3 += step)
639b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        {
640b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            p_temp2 = &rr[i3][0];
641b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            s  = (Word32) * (p_temp2 + i3) >> 1;
642b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            s += (Word32) * (p_temp2 + i0);
643b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            s += (Word32) * (p_temp2 + i1);
644b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            *(p_temp1++) = ps0 + dn[i3];
645b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            *(p_temp1++) = (Word16)((s + 2) >> 2);
646b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        }
647b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
648b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        /* Default value */
649b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        sq = -1;
650b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        alp = 1;
651b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        ps = 0;
652b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        ia = ipos[2];
653b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        ib = ipos[3];
654b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
655b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        s = (alp0 >> 12);
656b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
657b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        for (j = ipos[2]; j < L_CODE; j += step)
658b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        {
659b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            /* index increment = step  */
660b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            p_temp2 = &rr[j][0];
661b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
662b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            alp1 = (s + (Word32) * (p_temp2 + j)) >> 1;
663b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
664b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            alp1 += (Word32) * (p_temp2 + i0);
665b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
666b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            alp1 += (Word32) * (p_temp2 + i1);
667b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
668b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            p_temp1 = temp1;
669b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            ps1 = dn[j];
670b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
671b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
672b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            for (i3 = ipos[3]; i3 < L_CODE; i3 += step)
673b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            {
674b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                /* index increment = step */
675b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                ps2 = ps1 + *(p_temp1++);
676b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
677b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                sq2 = (Word16)(((Word32) ps2 * ps2) >> 15);
678b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
679b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                alp2 = (alp1 + p_temp2[i3]) >> 2;
680b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                alp2 = (alp2 + *(p_temp1++)) >> 1;  /*  alp2 is always > 0  */
681b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                if (((Word32) sq2 * alp) > ((Word32) sq * alp2))
682b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                {
683b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                    sq = sq2;
684b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                    ps = ps2;
685b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                    alp = (Word16)alp2;
686b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                    ia = j;
687b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                    ib = i3;
688b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                }
689b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            }
690b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
691b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        }
692b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        i2 = ia;
693b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        i3 = ib;
694b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        index[2] = ia;
695b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        index[3] = ib;
696b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
697b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        /*----------------------------------------------------------------*
698b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        * i4 and i5 loop:                                                *
699b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        *----------------------------------------------------------------*/
700b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
701b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        alp0 = ((Word32) alp << 15) + 0x00008000L;
702b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        p_temp1 = temp1;
703b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
704b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        for (i5 = ipos[5]; i5 < L_CODE; i5 += step)
705b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        {
706b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            p_temp2 = &rr[i5][0];
707b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            s = (Word32) * (p_temp2 + i5) >> 1;
708b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            s += (Word32) * (p_temp2 + i0);
709b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            s += (Word32) * (p_temp2 + i1);
710b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            s += (Word32) * (p_temp2 + i2);
711b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            s += (Word32) * (p_temp2 + i3);
712b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
713b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            *(p_temp1++) = ps + dn[i5];
714b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            *(p_temp1++) = (Word16)((s + 2) >> 2);
715b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        }
716b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
717b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        /* Default value */
718b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        sq = -1;
719b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        alp = 1;
720b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        ps = 0;
721b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        ia = ipos[4];
722b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        ib = ipos[5];
723b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
724b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        for (j = ipos[4]; j < L_CODE; j += step)
725b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        {
726b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            /* ps1 = add (ps0, dn[i4], pOverflow); */
727b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            p_temp2 = &rr[j][0];
728b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
729b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            /* alp1 = L_mac (alp0, rr[i4][i4], _1_32, pOverflow); */
730b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            alp1 = alp0 + ((Word32) * (p_temp2 + j) << 11);
731b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
732b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            /* alp1 = L_mac (alp1, rr[i0][i4], _1_16, pOverflow); */
733b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            alp1 += (Word32) * (p_temp2 + i0) << 12;
734b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
735b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            /* alp1 = L_mac (alp1, rr[i1][i4], _1_16, pOverflow); */
736b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            alp1 += (Word32) * (p_temp2 + i1) << 12;
737b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
738b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            /* alp1 = L_mac (alp1, rr[i2][i4], _1_16, pOverflow); */
739b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            alp1 += (Word32) * (p_temp2 + i2) << 12;
740b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
741b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            /* alp1 = L_mac (alp1, rr[i3][i4], _1_16, pOverflow); */
742b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            alp1 += (Word32) * (p_temp2 + i3) << 12;
743b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
744b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            p_temp1 = temp1;
745b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            ps1 =  dn[j];
746b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
747b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            for (i5 = ipos[5]; i5 < L_CODE; i5 += step)
748b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            {
749b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                ps2 = ps1 + *(p_temp1++);
750b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
751b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                alp2 = alp1 + ((Word32) * (p_temp2 + i5) << 12);
752b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
753b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                alp_16 = (Word16)((alp2 + ((Word32) * (p_temp1++) << 14)) >> 16);
754b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                sq2 = (Word16)(((Word32) ps2 * ps2) >> 15);
755b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
756b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                if (((Word32) sq2 * alp) > ((Word32) sq * alp_16))
757b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                {
758b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                    sq = sq2;
759b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                    ps = ps2;
760b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                    alp = alp_16;
761b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                    ia = j;
762b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                    ib = i5;
763b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                }
764b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
765b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            }
766b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        }
767b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        i4 = ia;
768b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        i5 = ib;
769b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        index[4] = ia;
770b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        index[5] = ib;
771b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
772b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        /*----------------------------------------------------------------*
773b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        * i6 and i7 loop:                                                *
774b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        *----------------------------------------------------------------*/
775b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
776b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        alp0 = ((Word32) alp << 15) + 0x00008000L;
777b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
778b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        p_temp1 = temp1;
779b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
780b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        for (i7 = ipos[7]; i7 < L_CODE; i7 += step)
781b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        {
782b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            s = (Word32) rr[i7][i7] >> 1;
783b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            s += (Word32) rr[i0][i7];
784b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            s += (Word32) rr[i1][i7];
785b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            s += (Word32) rr[i2][i7];
786b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            s += (Word32) rr[i3][i7];
787b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            s += (Word32) rr[i4][i7];
788b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            s += (Word32) rr[i5][i7];
789b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            *(p_temp1++) = ps + dn[i7];
790b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            *(p_temp1++) = (Word16)((s + 4) >> 3);
791b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        }
792b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
793b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
794b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        /* Default value */
795b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        sq = -1;
796b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        alp = 1;
797b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        ps = 0;
798b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        ia = ipos[6];
799b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        ib = ipos[7];
800b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
801b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        for (j = ipos[6]; j < L_CODE; j += step)
802b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        {
803b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            /* ps1 = add (ps0, dn[i6], pOverflow); */
804b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
805b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            p_temp2 = (Word16 *) & rr[j];
806b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
807b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            /* alp1 = L_mac (alp0, rr[i6][i6], _1_64, pOverflow); */
808b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            alp1 = alp0 + ((Word32) * (p_temp2 + j) << 10);
809b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
810b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            /* alp1 = L_mac (alp1, rr[i0][i6], _1_32, pOverflow); */
811b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            alp1 += (Word32) * (p_temp2 + i0) << 11;
812b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
813b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
814b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            /* alp1 = L_mac (alp1, rr[i1][i6], _1_32, pOverflow); */
815b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            alp1 += (Word32) * (p_temp2 + i1) << 11;
816b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
817b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            /* alp1 = L_mac (alp1, rr[i2][i6], _1_32, pOverflow); */
818b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            alp1 += (Word32) * (p_temp2 + i2) << 11;
819b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
820b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            /* alp1 = L_mac (alp1, rr[i3][i6], _1_32, pOverflow); */
821b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            alp1 += (Word32) * (p_temp2 + i3) << 11;
822b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
823b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            /* alp1 = L_mac (alp1, rr[i4][i6], _1_32, pOverflow); */
824b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            alp1 += (Word32) * (p_temp2 + i4) << 11;
825b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
826b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            /* alp1 = L_mac (alp1, rr[i5][i6], _1_32, pOverflow); */
827b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            alp1 += (Word32) * (p_temp2 + i5) << 11;
828b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
829b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            p_temp1 = temp1;
830b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            ps1 = dn[j];
831b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
832b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            for (i7 = ipos[7]; i7 < L_CODE; i7 += step)
833b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            {
834b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                ps2 = ps1 + *(p_temp1++);
835b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
836b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                alp2 = alp1 + ((Word32) * (p_temp2 + i7) << 11);
837b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
838b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                alp_16 = (Word16)((alp2 + ((Word32) * (p_temp1++) << 14)) >> 16);
839b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
840b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                sq2 = (Word16)(((Word32) ps2 * ps2) >> 15);
841b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
842b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                if (((Word32) sq2 * alp) > ((Word32) sq * alp_16))
843b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                {
844b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                    sq = sq2;
845b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                    ps = ps2;
846b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                    alp = alp_16;
847b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                    ia = j;
848b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                    ib = i7;
849b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                }
850b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            }
851b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        }
852b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
853b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        i6 = ia;
854b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        i7 = ib;
855b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        index[6] = ia;
856b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        index[7] = ib;
857b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
858b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        /* now finished searching a set of 8 pulses */
859b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
860b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        if (gsmefrFlag != 0)
861b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        {
862b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            /* go on with the two last pulses for GSMEFR                      */
863b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            /*----------------------------------------------------------------*
864b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            * i8 and i9 loop:                                                *
865b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            *----------------------------------------------------------------*/
866b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
867b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            alp0 = ((Word32) alp << 15) + 0x00008000L;
868b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
869b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            p_temp1 = temp1;
870b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
871b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            for (i9 = ipos[9]; i9 < L_CODE; i9 += step)
872b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            {
873b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                s = (Word32) rr[i9][i9] >> 1;
874b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                s += (Word32) rr[i0][i9];
875b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                s += (Word32) rr[i1][i9];
876b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                s += (Word32) rr[i2][i9];
877b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                s += (Word32) rr[i3][i9];
878b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                s += (Word32) rr[i4][i9];
879b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                s += (Word32) rr[i5][i9];
880b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                s += (Word32) rr[i6][i9];
881b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                s += (Word32) rr[i7][i9];
882b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
883b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                *(p_temp1++) = ps + dn[i9];
884b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                *(p_temp1++) = (Word16)((s + 4) >> 3);
885b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            }
886b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
887b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            /* Default value */
888b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            sq = -1;
889b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            alp = 1;
890b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            ps = 0;
891b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            ia = ipos[8];
892b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            ib = ipos[9];
893b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
894b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            for (j = ipos[8]; j < L_CODE; j += step)
895b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            {
896b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                /* ps1 = add (ps0, dn[i8], pOverflow); */
897b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                p_temp2 = &rr[j][0];
898b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
899b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                /* alp1 = L_mac (alp0, rr[i8][i8], _1_128, pOverflow); */
900b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                alp1 = alp0 + ((Word32) * (p_temp2 + j) << 9);
901b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
902b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                /* alp1 = L_mac (alp1, rr[i0][i8], _1_64, pOverflow); */
903b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                alp1 += (Word32) rr[i0][j] << 10;
904b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
905b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                /* alp1 = L_mac (alp1, rr[i1][i8], _1_64, pOverflow); */
906b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                alp1 += (Word32) rr[i1][j] << 10;
907b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
908b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                /* alp1 = L_mac (alp1, rr[i2][i8], _1_64, pOverflow); */
909b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                alp1 += (Word32) rr[i2][j] << 10;
910b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
911b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                /* alp1 = L_mac (alp1, rr[i3][i8], _1_64, pOverflow); */
912b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                alp1 += (Word32) rr[i3][j] << 10;
913b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
914b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                /* alp1 = L_mac (alp1, rr[i4][i8], _1_64, pOverflow); */
915b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                alp1 += (Word32) rr[i4][j] << 10;
916b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
917b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                /* alp1 = L_mac (alp1, rr[i5][i8], _1_64, pOverflow); */
918b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                alp1 += (Word32) rr[i5][j] << 10;
919b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
920b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                /* alp1 = L_mac (alp1, rr[i6][i8], _1_64, pOverflow); */
921b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                alp1 += (Word32) rr[i6][j] << 10;
922b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
923b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                /* alp1 = L_mac (alp1, rr[i7][i8], _1_64, pOverflow); */
924b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                alp1 += (Word32) rr[i7][j] << 10;
925b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
926b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                p_temp1 = temp1;
927b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                ps1 = dn[j];
928b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
929b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                for (i9 = ipos[9]; i9 < L_CODE; i9 += step)
930b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                {
931b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                    /* ps2 = add (ps1, dn[i9], pOverflow); */
932b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                    ps2 = ps1 + *(p_temp1++);
933b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
934b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                    /* sq2 = mult (ps2, ps2, pOverflow); */
935b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                    sq2 = (Word16)(((Word32) ps2 * ps2) >> 15);
936b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
937b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                    /* alp2 = L_mac (alp1, rrv[i9], _1_8, pOverflow); */
938b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                    alp2 = alp1 + ((Word32) * (p_temp2 + i9) << 10) ;
939b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
940b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                    /* alp2 = L_mac (alp2, rr[i8][i9], _1_64, pOverflow); */
941b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                    alp_16 = (Word16)((alp2 + ((Word32) * (p_temp1++) << 13)) >> 16);
942b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
943b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                    if (((Word32) sq2 * alp) > ((Word32) sq * alp_16))
944b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                    {
945b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                        sq = sq2;
946b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                        ps = ps2;
947b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                        alp = alp_16;
948b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                        ia = j;
949b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                        ib = i9;
950b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                    }
951b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                }
952b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            }
953b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
954b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            index[8] = ia;
955b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            index[9] = ib;
956b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
957b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        }/* end  gsmefrFlag */
958b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
959b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        /*----------------------------------------------------------------  *
960b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber         * test and memorise if this combination is better than the last one.*
961b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber         *----------------------------------------------------------------*/
962b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
963b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        if (((Word32) alpk * sq) > ((Word32) psk * alp))
964b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        {
965b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            psk = sq;
966b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            alpk = alp;
967b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
968b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            if (gsmefrFlag != 0)
969b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            {
970b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                memcpy(codvec, index, (2*NB_TRACK)*sizeof(*index));
971b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            }
972b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            else
973b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            {
974b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber                memcpy(codvec, index, (2*NB_TRACK_MR102)*sizeof(*index));
975b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            }
976b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
977b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        }
978b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        /*----------------------------------------------------------------*
979b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        * Cyclic permutation of i1,i2,i3,i4,i5,i6,i7,(i8 and i9).          *
980b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        *----------------------------------------------------------------*/
981b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
982b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        pos = ipos[1];
983b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        for (j = 1, k = 2; k < nbPulse; j++, k++)
984b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        {
985b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber            ipos[j] = ipos[k];
986b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        }
987b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber        ipos[nbPulse-1] = pos;
988b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber    } /* end 1..nbTracks  loop*/
989b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber}
990b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber
991