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/cor_h_x2.c 35b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 36b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Date: 11/07/2001 37b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 38b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 39b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REVISION HISTORY 40b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 41b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Created a separate file for cor_h_x2 function. 42b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 43b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Fixed typecasting issue with TI C compiler and defined one 44b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber local variable per line. Updated copyright year. 45b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 46b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Added #define for log2(32) = 5. 47b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 48b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Added call to round() and L_shl() functions in the last FOR 49b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber loop to make code bit-exact. 50b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 51b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Added pOverflow as a variable that's passed in for the EPOC 52b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber modifications. 53b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 54b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Changed round function name to pv_round to avoid conflict with 55b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber round function in C standard library. 56b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 57b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Using intrinsics from fxp_arithmetic.h . 58b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 59b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Replacing fxp_arithmetic.h with basic_op.h. 60b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 61b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: 62b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 63b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 64b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber*/ 65b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 66b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 67b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; INCLUDES 68b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 69b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "typedef.h" 70b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "cnst.h" 71b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "cor_h_x.h" 72b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "cor_h_x2.h" // BX 73b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "basic_op.h" 74b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 75b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 76b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; MACROS 77b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; Define module specific macros here 78b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 79b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 80b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 81b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 82b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; DEFINES 83b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; Include all pre-processor statements here. Include conditional 84b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; compile variables also. 85b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 86b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#define LOG2_OF_32 5 87b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 88b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 89b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; LOCAL FUNCTION DEFINITIONS 90b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; Function Prototype declaration 91b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 92b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 93b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 94b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; LOCAL STORE/BUFFER/POINTER DEFINITIONS 95b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; Variable declaration - defined here and used outside this module 96b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 97b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 98b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 99b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/* 100b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 101b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION NAME: cor_h_x2 102b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 103b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber INPUT AND OUTPUT DEFINITIONS 104b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 105b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Inputs: 106b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber h = vector containing the impulse response of the weighted synthesis 107b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber filter; vector contents are of type Word16; vector length is 108b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 2 * L_SUBFR 109b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber x = target signal vector; vector contents are of type Word16; vector 110b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber length is L_SUBFR 111b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dn = vector containing the correlation between the target and the 112b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber impulse response; vector contents are of type Word16; vector 113b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber length is L_CODE 114b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber sf = scaling factor of type Word16 ; 2 when mode is MR122, 1 for all 115b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber other modes 116b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber nb_track = number of ACB tracks (Word16) 117b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber step = step size between pulses in one track (Word16) 118b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow = pointer to overflow (Flag) 119b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 120b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Outputs: 121b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dn contents are the newly calculated correlation values 122b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow = 1 if the math functions called by cor_h_x2 result in overflow 123b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else zero. 124b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 125b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Returns: 126b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 127b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 128b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Global Variables Used: 129b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 130b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 131b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Local Variables Needed: 132b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 133b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 134b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 135b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION DESCRIPTION 136b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 137b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber This function computes the correlation between the target signal (x) and the 138b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber impulse response (h). 139b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 140b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber The correlation is given by: d[n] = sum_{i=n}^{L-1} x[i] h[i-n], 141b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber where: n=0,...,L-1 142b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 143b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber d[n] is normalized such that the sum of 5 maxima of d[n] corresponding to 144b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber each position track does not saturate. 145b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 146b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 147b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REQUIREMENTS 148b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 149b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 150b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 151b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 152b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REFERENCES 153b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 154b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber cor_h.c, UMTS GSM AMR speech codec, R99 - Version 3.2.0, March 2, 2001 155b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 156b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 157b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber PSEUDO-CODE 158b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 159b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas HuberThe original etsi reference code uses a global flag Overflow. However, in the 160b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huberactual implementation a pointer to a the overflow flag is passed in. 161b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 162b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Hubervoid cor_h_x2 ( 163b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 h[], // (i): impulse response of weighted synthesis filter 164b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 x[], // (i): target 165b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 dn[], // (o): correlation between target and h[] 166b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 sf, // (i): scaling factor: 2 for 12.2, 1 for others 167b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 nb_track,// (i): the number of ACB tracks 168b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 step // (i): step size from one pulse position to the next 169b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber in one track 170b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber) 171b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 172b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 i, j, k; 173b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 s, y32[L_CODE], max, tot; 174b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 175b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // first keep the result on 32 bits and find absolute maximum 176b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 177b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tot = 5; 178b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 179b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (k = 0; k < nb_track; k++) 180b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 181b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber max = 0; 182b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = k; i < L_CODE; i += step) 183b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 184b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = 0; 185b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (j = i; j < L_CODE; j++) 186b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = L_mac (s, x[j], h[j - i]); 187b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 188b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber y32[i] = s; 189b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 190b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = L_abs (s); 191b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (L_sub (s, max) > (Word32) 0L) 192b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber max = s; 193b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 194b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tot = L_add (tot, L_shr (max, 1)); 195b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 196b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 197b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber j = sub (norm_l (tot), sf); 198b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 199b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 0; i < L_CODE; i++) 200b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 201b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dn[i] = pv_round (L_shl (y32[i], j)); 202b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 203b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 204b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 205b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 206b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber RESOURCES USED [optional] 207b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 208b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber When the code is written for a specific target processor the 209b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber the resources used should be documented below. 210b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 211b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber HEAP MEMORY USED: x bytes 212b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 213b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber STACK MEMORY USED: x bytes 214b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 215b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CLOCK CYCLES: (cycle count equation for this function) + (variable 216b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber used to represent cycle count for each subroutine 217b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber called) 218b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber where: (cycle count variable) = cycle count for [subroutine 219b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber name] 220b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 221b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 222b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CAUTION [optional] 223b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber [State any special notes, constraints or cautions for users of this function] 224b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 225b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 226b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber*/ 227b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 228b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Hubervoid cor_h_x2( 229b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 h[], /* (i): impulse response of weighted synthesis filter */ 230b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 x[], /* (i): target */ 231b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 dn[], /* (o): correlation between target and h[] */ 232b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 sf, /* (i): scaling factor: 2 for 12.2, 1 for others */ 233b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 nb_track,/* (i): the number of ACB tracks */ 234b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 step, /* (i): step size from one pulse position to the next 235b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber in one track */ 236b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Flag *pOverflow 237b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber) 238b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 239b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber register Word16 i; 240b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber register Word16 j; 241b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber register Word16 k; 242b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 s; 243b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 y32[L_CODE]; 244b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 max; 245b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 tot; 246b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 247b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 248b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* first keep the result on 32 bits and find absolute maximum */ 249b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tot = LOG2_OF_32; 250b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (k = 0; k < nb_track; k++) 251b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 252b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber max = 0; 253b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = k; i < L_CODE; i += step) 254b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 255b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = 0; 256b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 257b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (j = i; j < L_CODE; j++) 258b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 259b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = amrnb_fxp_mac_16_by_16bb((Word32)x[j], (Word32)h[j-i], s); 260b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 261b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 262b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = s << 1; 263b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber y32[i] = s; 264b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = L_abs(s); 265b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 266b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (s > max) 267b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 268b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber max = s; 269b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 270b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 271b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tot = (tot + (max >> 1)); 272b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 273b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 274b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber j = sub(norm_l(tot), sf, pOverflow); 275b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 276b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 0; i < L_CODE; i++) 277b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 278b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dn[i] = pv_round(L_shl(y32[i], j, pOverflow), pOverflow); 279b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 280b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 281b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return; 282b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 283