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/g_pitch.c 35b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 36b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Date: 06/12/2000 37b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 38b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 39b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REVISION HISTORY 40b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 41b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Placed into template and began to optimize. 42b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 43b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Synchronized file with UMTS version 3.2.0. Updated coding 44b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber template. Removed unnecessary include files. 45b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 46b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Replaced basic_op.h and oper_32b.h with the header files of the 47b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber math functions used in the file. Fixed typecasting issue with 48b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber TI compiler. 49b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 50b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Passing in pointer to overflow flag for EPOC compatibility. . 51b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 52b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: 53b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1. Eliminated unused include files. 54b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 2. Replaced array addressing by pointers 55b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 3. Eliminated math operations that unnecessary checked for 56b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber saturation, in some cases this by shifting before adding and 57b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber in other cases by evaluating the operands 58b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 4. Unrolled loops to speed up processing 59b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 60b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Replaced OSCL mem type functions and eliminated include 61b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber files that now are chosen by OSCL definitions 62b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 63b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Replaced "int" and/or "char" with OSCL defined types. 64b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 65b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Changed round function name to pv_round to avoid conflict with 66b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber round function in C standard library. 67b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 68b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Using inlines from fxp_arithmetic.h . 69b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 70b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Replacing fxp_arithmetic.h with basic_op.h. 71b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 72b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: 73b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 74b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 75b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber*/ 76b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 77b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 78b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; INCLUDES 79b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 80b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "g_pitch.h" 81b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "mode.h" 82b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "cnst.h" 83b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "basic_op.h" 84b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 85b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 86b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; MACROS 87b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; Define module specific macros here 88b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 89b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 90b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 91b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 92b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; DEFINES 93b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; Include all pre-processor statements here. Include conditional 94b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; compile variables also. 95b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 96b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 97b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 98b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; LOCAL FUNCTION DEFINITIONS 99b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; Function Prototype declaration 100b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 101b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 102b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 103b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; LOCAL STORE/BUFFER/POINTER DEFINITIONS 104b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; Variable declaration - defined here and used outside this module 105b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 106b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 107b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 108b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/* 109b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 110b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION NAME: G_pitch 111b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 112b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber INPUT AND OUTPUT DEFINITIONS 113b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 114b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Inputs: 115b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber mode = AMR mode (enum Mode) 116b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber xn = pointer to pitch target buffer (Word16) 117b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber y1 = pointer to filtered adaptive codebook buffer (Word16) 118b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber g_coeff = pointer to buffer of correlations needed for gain quantization 119b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber (Word16) 120b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_subfr = length of subframe (Word16) 121b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow = pointer to overflow flag (Flag) 122b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 123b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Outputs: 124b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber g_coeff contains the mantissa and exponent of the two dot products. 125b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow -> 1 if an overflow occurs 126b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 127b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Returns: 128b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber gain = ratio of dot products.(Word16) 129b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 130b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Global Variables Used: 131b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None. 132b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 133b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Local Variables Needed: 134b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None. 135b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 136b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 137b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION DESCRIPTION 138b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 139b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber This function computes the pitch (adaptive codebook) gain. The adaptive 140b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber codebook gain is given by 141b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 142b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber g = <x[], y[]> / <y[], y[]> 143b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 144b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber where: x[] is the target vector 145b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber y[] is the filtered adaptive codevector 146b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber <> denotes dot product. 147b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 148b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber The gain is limited to the range [0,1.2] (=0..19661 Q14) 149b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 150b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 151b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REQUIREMENTS 152b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 153b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None. 154b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 155b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 156b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REFERENCES 157b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 158b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber g_pitch.c, UMTS GSM AMR speech codec, R99 - Version 3.2.0, March 2, 2001 159b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 160b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 161b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber PSEUDO-CODE 162b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 163b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas HuberWord16 G_pitch ( // o : Gain of pitch lag saturated to 1.2 164b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber enum Mode mode, // i : AMR mode 165b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 xn[], // i : Pitch target. 166b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 y1[], // i : Filtered adaptive codebook. 167b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 g_coeff[], // i : Correlations need for gain quantization 168b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 L_subfr // i : Length of subframe. 169b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber) 170b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 171b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 i; 172b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 xy, yy, exp_xy, exp_yy, gain; 173b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 s; 174b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 175b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 scaled_y1[L_SUBFR]; // Usually dynamic allocation of (L_subfr) 176b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 177b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // divide "y1[]" by 4 to avoid overflow 178b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 179b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber// The reference ETSI code uses a global overflow Flag. However in the actual 180b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber// implementation a pointer to the overflow flag is passed into the function. 181b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 182b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 0; i < L_subfr; i++) 183b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 184b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scaled_y1[i] = shr (y1[i], 2); 185b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 186b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 187b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // Compute scalar product <y1[],y1[]> 188b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 189b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // Q12 scaling / MR122 190b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Overflow = 0; 191b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = 1L; // Avoid case of all zeros 192b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 0; i < L_subfr; i++) 193b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 194b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = L_mac (s, y1[i], y1[i]); 195b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 196b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (Overflow == 0) // Test for overflow 197b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 198b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_yy = norm_l (s); 199b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber yy = pv_round (L_shl (s, exp_yy)); 200b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 201b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 202b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 203b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = 1L; // Avoid case of all zeros 204b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 0; i < L_subfr; i++) 205b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 206b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = L_mac (s, scaled_y1[i], scaled_y1[i]); 207b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 208b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_yy = norm_l (s); 209b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber yy = pv_round (L_shl (s, exp_yy)); 210b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_yy = sub (exp_yy, 4); 211b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 212b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 213b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // Compute scalar product <xn[],y1[]> 214b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 215b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Overflow = 0; 216b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = 1L; // Avoid case of all zeros 217b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 218b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 0; i < L_subfr; i++) 219b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 220b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = L_mac(s, xn[i], y1[i]); 221b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 222b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (Overflow == 0) 223b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 224b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_xy = norm_l (s); 225b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber xy = pv_round (L_shl (s, exp_xy)); 226b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 227b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 228b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 229b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = 1L; // Avoid case of all zeros 230b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 0; i < L_subfr; i++) 231b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 232b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = L_mac (s, xn[i], scaled_y1[i]); 233b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 234b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_xy = norm_l (s); 235b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber xy = pv_round (L_shl (s, exp_xy)); 236b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_xy = sub (exp_xy, 2); 237b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 238b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 239b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber g_coeff[0] = yy; 240b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber g_coeff[1] = sub (15, exp_yy); 241b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber g_coeff[2] = xy; 242b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber g_coeff[3] = sub (15, exp_xy); 243b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 244b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // If (xy < 4) gain = 0 245b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 246b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber i = sub (xy, 4); 247b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 248b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (i < 0) 249b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return ((Word16) 0); 250b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 251b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // compute gain = xy/yy 252b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 253b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber xy = shr (xy, 1); // Be sure xy < yy 254b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber gain = div_s (xy, yy); 255b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 256b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber i = sub (exp_xy, exp_yy); // Denormalization of division 257b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber gain = shr (gain, i); 258b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 259b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // if(gain >1.2) gain = 1.2 260b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 261b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (sub (gain, 19661) > 0) 262b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 263b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber gain = 19661; 264b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 265b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 266b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (sub(mode, MR122) == 0) 267b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 268b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // clear 2 LSBits 269b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber gain = gain & 0xfffC; 270b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 271b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 272b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return (gain); 273b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 274b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 275b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 276b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber RESOURCES USED [optional] 277b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 278b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber When the code is written for a specific target processor the 279b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber the resources used should be documented below. 280b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 281b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber HEAP MEMORY USED: x bytes 282b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 283b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber STACK MEMORY USED: x bytes 284b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 285b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CLOCK CYCLES: (cycle count equation for this function) + (variable 286b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber used to represent cycle count for each subroutine 287b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber called) 288b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber where: (cycle count variable) = cycle count for [subroutine 289b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber name] 290b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 291b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 292b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CAUTION [optional] 293b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber [State any special notes, constraints or cautions for users of this function] 294b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 295b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 296b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber*/ 297b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 298b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas HuberWord16 G_pitch( /* o : Gain of pitch lag saturated to 1.2 */ 299b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber enum Mode mode, /* i : AMR mode */ 300b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 xn[], /* i : Pitch target. Q0 */ 301b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 y1[], /* i : Filtered adaptive codebook. Q12 */ 302b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 g_coeff[], /* i : Correlations need for gain quantization */ 303b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 L_subfr, /* i : Length of subframe. */ 304b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Flag *pOverflow /* i/o : Overflow flag */ 305b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber) 306b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 307b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 308b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 i; 309b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 xy; 310b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 yy; 311b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 exp_xy; 312b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 exp_yy; 313b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 gain; 314b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 tmp; 315b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 s; 316b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 s1; 317b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 L_temp; /* Use this as an intermediate value */ 318b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *p_xn = &xn[0]; 319b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *p_y1 = &y1[0]; 320b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 321b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* Compute scalar product <y1[],y1[]> */ 322b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 323b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* Q12 scaling / MR122 */ 324b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *pOverflow = 0; 325b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = 0; 326b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 327b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = L_subfr >> 2; i != 0; i--) 328b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 329b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = amrnb_fxp_mac_16_by_16bb((Word32) * (p_y1), (Word32) * (p_y1), s); 330b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_y1++; 331b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = amrnb_fxp_mac_16_by_16bb((Word32) * (p_y1), (Word32) * (p_y1), s); 332b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_y1++; 333b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = amrnb_fxp_mac_16_by_16bb((Word32) * (p_y1), (Word32) * (p_y1), s); 334b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_y1++; 335b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = amrnb_fxp_mac_16_by_16bb((Word32) * (p_y1), (Word32) * (p_y1), s); 336b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_y1++; 337b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 338b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if ((s >= 0) & (s < 0x40000000)) 339b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 340b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s <<= 1; 341b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s += 1; /* Avoid case of all zeros */ 342b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 343b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_yy = norm_l(s); /* Note 0<=exp_yy <= 31 */ 344b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_temp = s << exp_yy; 345b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber yy = pv_round(L_temp, pOverflow); 346b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 347b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 348b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 349b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = 0; /* Avoid case of all zeros */ 350b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_y1 = &y1[0]; 351b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = (L_subfr >> 1); i != 0; i--) 352b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 353b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tmp = *(p_y1++) >> 2; 354b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = amrnb_fxp_mac_16_by_16bb((Word32) tmp, (Word32) tmp, s); 355b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tmp = *(p_y1++) >> 2; 356b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = amrnb_fxp_mac_16_by_16bb((Word32) tmp, (Word32) tmp, s); 357b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 358b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 359b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s <<= 1; 360b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s += 1; /* Avoid case of all zeros */ 361b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 362b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_yy = norm_l(s); 363b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_temp = s << exp_yy; 364b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber yy = pv_round(L_temp, pOverflow); 365b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_yy = exp_yy - 4; 366b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 367b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 368b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 369b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* Compute scalar product <xn[],y1[]> */ 370b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 371b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = 0; 372b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_y1 = &y1[0]; 373b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *pOverflow = 0; 374b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 375b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = L_subfr; i != 0; i--) 376b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 377b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_temp = ((Word32) * (p_xn++) * *(p_y1++)); 378b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s1 = s; 379b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = s1 + L_temp; 380b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 381b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if ((s1 ^ L_temp) > 0) 382b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 383b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if ((s1 ^ s) < 0) 384b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 385b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *pOverflow = 1; 386b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber break; 387b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 388b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 389b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 390b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 391b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (!(*pOverflow)) 392b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 393b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 394b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s <<= 1; 395b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s += 1; /* Avoid case of all zeros */ 396b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 397b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_xy = norm_l(s); /* Note 0<=exp_yy <= 31 */ 398b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_temp = s << exp_xy; 399b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber xy = pv_round(L_temp, pOverflow); 400b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 401b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 402b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 4036d72a807dc3910ddd0b7c4f85130951dd189e8f5Martin Storsjo s = 0; /* re-initialize calculations */ 404b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_y1 = &y1[0]; 4056d72a807dc3910ddd0b7c4f85130951dd189e8f5Martin Storsjo p_xn = &xn[0]; 406b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = (L_subfr >> 2); i != 0; i--) 407b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 408b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_temp = (Word32)(*(p_y1++) >> 2); 409b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = amrnb_fxp_mac_16_by_16bb((Word32) * (p_xn++), L_temp, s); 410b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_temp = (Word32)(*(p_y1++) >> 2); 411b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = amrnb_fxp_mac_16_by_16bb((Word32) * (p_xn++), L_temp, s); 412b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_temp = (Word32)(*(p_y1++) >> 2); 413b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = amrnb_fxp_mac_16_by_16bb((Word32) * (p_xn++), L_temp, s); 414b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_temp = (Word32)(*(p_y1++) >> 2); 415b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = amrnb_fxp_mac_16_by_16bb((Word32) * (p_xn++), L_temp, s); 416b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 417b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 418b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s <<= 1; 419b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s += 1; /* Avoid case of all zeros */ 420b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 421b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_xy = norm_l(s); 422b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_temp = s << exp_xy; 423b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber xy = pv_round(L_temp, pOverflow); 424b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_xy = exp_xy - 4; 425b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 426b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 427b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 428b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber g_coeff[0] = yy; 429b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber g_coeff[1] = 15 - exp_yy; 430b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber g_coeff[2] = xy; 431b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber g_coeff[3] = 15 - exp_xy; 432b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 433b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* If (xy < 4) gain = 0 */ 434b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (xy < 4) 435b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 436b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return ((Word16) 0); 437b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 438b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 439b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* compute gain = xy/yy */ 440b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* Be sure xy < yy */ 441b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 442b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber xy = xy >> 1; 443b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 444b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber gain = div_s(xy, yy); 445b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 446b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber i = exp_xy - exp_yy; /* Denormalization of division */ 447b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 448b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber gain = shr(gain, i, pOverflow); 449b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 450b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 451b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* if(gain >1.2) gain = 1.2 */ 452b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (gain > 19661) 453b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 454b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber gain = 19661; 455b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 456b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 457b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (mode == MR122) 458b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 459b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* clear 2 LSBits */ 460b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber gain = gain & 0xfffC; 461b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 462b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 463b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return(gain); 464b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 465b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 466