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/qgain795.c 35b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Functions: MR795_gain_code_quant3 36b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber MR795_gain_code_quant_mod 37b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber MR795_gain_quant 38b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 39b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Date: 02/04/2002 40b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 41b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 42b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REVISION HISTORY 43b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 44b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Updated template used to PV coding template. 45b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Changed to accept the pOverflow flag for EPOC compatibility. 46b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 47b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: 48b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber (1) Removed optimization -- mult(i, 3, pOverflow) is NOT the same as adding 49b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber i to itself 3 times. The reason is because the mult function does a 50b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber right shift by 15, which will obliterate smaller numbers. 51b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 52b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Replaced OSCL mem type functions and eliminated include 53b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber files that now are chosen by OSCL definitions 54b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 55b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Replaced "int" and/or "char" with OSCL defined types. 56b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 57b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Changed round function name to pv_round to avoid conflict with 58b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber round function in C standard library. 59b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 60b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Added #ifdef __cplusplus around extern'ed table. 61b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 62b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: 63b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 64b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 65b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber MODULE DESCRIPTION 66b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 67b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 68b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 69b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber*/ 70b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 71b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 72b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; INCLUDES 73b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 74b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "qgain795.h" 75b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "typedef.h" 76b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "basic_op.h" 77b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "cnst.h" 78b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "log2.h" 79b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "pow2.h" 80b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "sqrt_l.h" 81b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "g_adapt.h" 82b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "calc_en.h" 83b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "q_gain_p.h" 84b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 85b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 86b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*--------------------------------------------------------------------------*/ 87b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#ifdef __cplusplus 88b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huberextern "C" 89b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 90b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#endif 91b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 92b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /*---------------------------------------------------------------------------- 93b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ; MACROS 94b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ; Define module specific macros here 95b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ----------------------------------------------------------------------------*/ 96b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 97b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /*---------------------------------------------------------------------------- 98b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ; DEFINES 99b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ; Include all pre-processor statements here. Include conditional 100b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ; compile variables also. 101b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ----------------------------------------------------------------------------*/ 102b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#define NB_QUA_CODE 32 103b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 104b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /*---------------------------------------------------------------------------- 105b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ; LOCAL FUNCTION DEFINITIONS 106b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ; Function Prototype declaration 107b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ----------------------------------------------------------------------------*/ 108b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 109b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /*---------------------------------------------------------------------------- 110b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ; LOCAL VARIABLE DEFINITIONS 111b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ; Variable declaration - defined here and used outside this module 112b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ----------------------------------------------------------------------------*/ 113b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 114b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /*---------------------------------------------------------------------------- 115b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ; EXTERNAL GLOBAL STORE/BUFFER/POINTER REFERENCES 116b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ; Declare variables used in this module but defined elsewhere 117b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ----------------------------------------------------------------------------*/ 118b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber extern const Word16 qua_gain_code[NB_QUA_CODE*3]; 119b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 120b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 121b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /*--------------------------------------------------------------------------*/ 122b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#ifdef __cplusplus 123b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 124b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#endif 125b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 126b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/* 127b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 128b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION NAME: MR795_gain_code_quant3 129b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 130b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber INPUT AND OUTPUT DEFINITIONS 131b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 132b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Inputs: 133b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_gcode0 -- Word16 -- predicted CB gain (exponent), Q0 134b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber gcode0 -- Word16 -- predicted CB gain (norm.) 135b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber g_pitch_cand[] -- Word16 array -- Pitch gain candidates (3), Q14 136b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber g_pitch_cind[] -- Word16 array -- Pitch gain cand. indices (3), Q0 137b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac_coeff[] -- Word16 array -- coefficients (5), Q15 138b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_coeff[] -- Word16 array -- energy coefficients (5), Q0 139b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber coefficients from calc_filt_ener() 140b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 141b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Outputs: 142b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber gain_pit -- Pointer to Word16 -- Pitch gain, Q14 143b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber gain_pit_ind -- Pointer to Word16 -- Pitch gain index, Q0 144b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber gain_cod -- Pointer to Word16 -- Code gain, Q1 145b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber gain_cod_ind -- Pointer to Word16 -- Code gain index, Q0 146b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber qua_ener_MR122 -- Pointer to Word16 -- quantized energy error, Q10 147b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber (for MR122 MA predictor update) 148b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 149b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber qua_ener -- Pointer to Word16 -- quantized energy error, Q10 150b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber (for other MA predictor update) 151b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 152b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow -- Pointer to Flag -- overflow indicator 153b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 154b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Returns: 155b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 156b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 157b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Global Variables Used: 158b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 159b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 160b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Local Variables Needed: 161b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 162b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 163b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 164b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION DESCRIPTION 165b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 166b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber PURPOSE: Pre-quantization of codebook gains, given three possible 167b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber LTP gains (using predicted codebook gain) 168b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 169b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REQUIREMENTS 170b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 171b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 172b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 173b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 174b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REFERENCES 175b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 176b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber qgain795.c, UMTS GSM AMR speech codec, R99 - Version 3.2.0, March 2, 2001 177b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 178b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 179b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber PSEUDO-CODE 180b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 181b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 182b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 183b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber RESOURCES USED [optional] 184b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 185b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber When the code is written for a specific target processor the 186b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber the resources used should be documented below. 187b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 188b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber HEAP MEMORY USED: x bytes 189b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 190b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber STACK MEMORY USED: x bytes 191b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 192b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CLOCK CYCLES: (cycle count equation for this function) + (variable 193b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber used to represent cycle count for each subroutine 194b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber called) 195b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber where: (cycle count variable) = cycle count for [subroutine 196b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber name] 197b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 198b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 199b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CAUTION [optional] 200b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber [State any special notes, constraints or cautions for users of this function] 201b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 202b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 203b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber*/ 204b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 205b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huberstatic void 206b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas HuberMR795_gain_code_quant3( 207b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 exp_gcode0, /* i : predicted CB gain (exponent), Q0 */ 208b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 gcode0, /* i : predicted CB gain (norm.), Q14 */ 209b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 g_pitch_cand[], /* i : Pitch gain candidates (3), Q14 */ 210b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 g_pitch_cind[], /* i : Pitch gain cand. indices (3), Q0 */ 211b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 frac_coeff[], /* i : coefficients (5), Q15 */ 212b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 exp_coeff[], /* i : energy coefficients (5), Q0 */ 213b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* coefficients from calc_filt_ener()*/ 214b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *gain_pit, /* o : Pitch gain, Q14 */ 215b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *gain_pit_ind, /* o : Pitch gain index, Q0 */ 216b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *gain_cod, /* o : Code gain, Q1 */ 217b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *gain_cod_ind, /* o : Code gain index, Q0 */ 218b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *qua_ener_MR122, /* o : quantized energy error, Q10 */ 219b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* (for MR122 MA predictor update) */ 220b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *qua_ener, /* o : quantized energy error, Q10 */ 221b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* (for other MA predictor update) */ 222b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Flag *pOverflow /* o : overflow indicator */ 223b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber) 224b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 225b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber const Word16 *p; 226b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 i; 227b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 j; 228b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 cod_ind; 229b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 pit_ind; 230b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 e_max; 231b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 exp_code; 232b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 g_pitch; 233b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 g2_pitch; 234b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 g_code; 235b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 g2_code_h; 236b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 g2_code_l; 237b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 g_pit_cod_h; 238b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 g_pit_cod_l; 239b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 coeff[5]; 240b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 coeff_lo[5]; 241b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 exp_max[5]; 242b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 L_tmp; 243b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 L_tmp0; 244b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 dist_min; 245b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 246b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* 247b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * The error energy (sum) to be minimized consists of five terms, t[0..4]. 248b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * 249b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * t[0] = gp^2 * <y1 y1> 250b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * t[1] = -2*gp * <xn y1> 251b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * t[2] = gc^2 * <y2 y2> 252b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * t[3] = -2*gc * <xn y2> 253b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * t[4] = 2*gp*gc * <y1 y2> 254b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * 255b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber */ 256b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 257b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* determine the scaling exponent for g_code: ec = ec0 - 10 */ 258b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_code = sub(exp_gcode0, 10, pOverflow); 259b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 260b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* calculate exp_max[i] = s[i]-1 */ 261b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_max[0] = sub(exp_coeff[0], 13, pOverflow); 262b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_max[1] = sub(exp_coeff[1], 14, pOverflow); 263b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_max[2] = add(exp_coeff[2], add(15, shl(exp_code, 1, pOverflow), pOverflow), pOverflow); 264b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_max[3] = add(exp_coeff[3], exp_code, pOverflow); 265b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_max[4] = add(exp_coeff[4], add(exp_code, 1, pOverflow), pOverflow); 266b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 267b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 268b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /*-------------------------------------------------------------------* 269b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * Find maximum exponent: * 270b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * ~~~~~~~~~~~~~~~~~~~~~~ * 271b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * * 272b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * For the sum operation, all terms must have the same scaling; * 273b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * that scaling should be low enough to prevent overflow. There- * 274b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * fore, the maximum scale is determined and all coefficients are * 275b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * re-scaled: * 276b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * * 277b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * e_max = max(exp_max[i]) + 1; * 278b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * e = exp_max[i]-e_max; e <= 0! * 279b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * c[i] = c[i]*2^e * 280b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *-------------------------------------------------------------------*/ 281b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 282b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber e_max = exp_max[0]; 283b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 1; i < 5; i++) /* implemented flattened */ 284b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 285b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (exp_max[i] > e_max) 286b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 287b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber e_max = exp_max[i]; 288b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 289b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 290b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 291b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber e_max = add(e_max, 1, pOverflow); /* To avoid overflow */ 292b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 293b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 0; i < 5; i++) 294b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 295b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber j = sub(e_max, exp_max[i], pOverflow); 296b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_tmp = L_deposit_h(frac_coeff[i]); 297b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_tmp = L_shr(L_tmp, j, pOverflow); 298b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_Extract(L_tmp, &coeff[i], &coeff_lo[i], pOverflow); 299b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 300b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 301b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 302b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /*-------------------------------------------------------------------* 303b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * Codebook search: * 304b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * ~~~~~~~~~~~~~~~~ * 305b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * * 306b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * For each of the candiates LTP gains in g_pitch_cand[], the terms * 307b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * t[0..4] are calculated from the values in the table (and the * 308b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * pitch gain candidate) and summed up; the result is the mean * 309b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * squared error for the LPT/CB gain pair. The index for the mini- * 310b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * mum MSE is stored and finally used to retrieve the quantized CB * 311b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * gain * 312b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *-------------------------------------------------------------------*/ 313b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 314b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* start with "infinite" MSE */ 315b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dist_min = MAX_32; 316b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber cod_ind = 0; 317b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pit_ind = 0; 318b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 319b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* loop through LTP gain candidates */ 320b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (j = 0; j < 3; j++) 321b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 322b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* pre-calculate terms only dependent on pitch gain */ 323b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber g_pitch = g_pitch_cand[j]; 324b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber g2_pitch = mult(g_pitch, g_pitch, pOverflow); 325b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_tmp0 = Mpy_32_16(coeff[0], coeff_lo[0], g2_pitch, pOverflow); 326b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_tmp0 = Mac_32_16(L_tmp0, coeff[1], coeff_lo[1], g_pitch, pOverflow); 327b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 328b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p = &qua_gain_code[0]; 329b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 0; i < NB_QUA_CODE; i++) 330b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 331b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber g_code = *p++; /* this is g_fac Q11 */ 332b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p++; /* skip log2(g_fac) */ 333b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p++; /* skip 20*log10(g_fac) */ 334b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 335b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber g_code = mult(g_code, gcode0, pOverflow); 336b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 337b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_tmp = L_mult(g_code, g_code, pOverflow); 338b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_Extract(L_tmp, &g2_code_h, &g2_code_l, pOverflow); 339b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 340b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_tmp = L_mult(g_code, g_pitch, pOverflow); 341b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_Extract(L_tmp, &g_pit_cod_h, &g_pit_cod_l, pOverflow); 342b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 343b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_tmp = Mac_32(L_tmp0, coeff[2], coeff_lo[2], 344b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber g2_code_h, g2_code_l, pOverflow); 345b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_tmp = Mac_32_16(L_tmp, coeff[3], coeff_lo[3], 346b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber g_code, pOverflow); 347b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_tmp = Mac_32(L_tmp, coeff[4], coeff_lo[4], 348b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber g_pit_cod_h, g_pit_cod_l, pOverflow); 349b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 350b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* store table index if MSE for this index is lower 351b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber than the minimum MSE seen so far; also store the 352b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pitch gain for this (so far) lowest MSE */ 353b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (L_tmp < dist_min) 354b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 355b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dist_min = L_tmp; 356b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber cod_ind = i; 357b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pit_ind = j; 358b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 359b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 360b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 361b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 362b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /*------------------------------------------------------------------* 363b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * read quantized gains and new values for MA predictor memories * 364b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ * 365b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *------------------------------------------------------------------*/ 366b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 367b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* Read the quantized gains */ 368b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p = &qua_gain_code[ 369b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber add(add(cod_ind, cod_ind, pOverflow), cod_ind, pOverflow)]; 370b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 371b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber g_code = *p++; 372b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *qua_ener_MR122 = *p++; 373b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *qua_ener = *p; 374b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 375b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /*------------------------------------------------------------------* 376b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * calculate final fixed codebook gain: * 377b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ * 378b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * * 379b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * gc = gc0 * g * 380b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *------------------------------------------------------------------*/ 381b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 382b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_tmp = L_mult(g_code, gcode0, pOverflow); 383b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_tmp = L_shr(L_tmp, sub(9, exp_gcode0, pOverflow), pOverflow); 384b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *gain_cod = extract_h(L_tmp); 385b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *gain_cod_ind = cod_ind; 386b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *gain_pit = g_pitch_cand[pit_ind]; 387b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *gain_pit_ind = g_pitch_cind[pit_ind]; 388b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 389b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 390b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 391b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/* 392b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 393b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION NAME: MR795_gain_code_quant_mod 394b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 395b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber INPUT AND OUTPUT DEFINITIONS 396b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 397b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Inputs: 398b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber gain_pit -- Word16 -- pitch gain, Q14 399b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_gcode0 -- Word16 -- predicted CB gain (exponent), Q0 400b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber gcode0 -- Word16 -- predicted CB gain (norm.), Q14 401b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac_en[] -- Word16 array -- energy coefficients (4), fraction part, Q15 402b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_en[] -- Word16 array -- energy coefficients (4), exponent part, Q0 403b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber alpha -- Word16 -- gain adaptor factor (>0), Q15 404b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 405b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber gain_cod_unq -- Word16 -- Code gain (unquantized) 406b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber (scaling: Q10 - exp_gcode0) 407b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 408b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber gain_cod -- Pointer to Word16 -- Code gain (pre-/quantized), Q1 409b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 410b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Outputs: 411b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber qua_ener_MR122 -- Pointer to Word16 -- quantized energy error, Q10 412b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber (for MR122 MA predictor update) 413b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber qua_ener -- Pointer to Word16 -- quantized energy error, Q10 414b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber (for other MA predictor update) 415b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow -- Pointer to Flag -- overflow indicator 416b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 417b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Returns: 418b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber index of quantization (Word16) 419b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 420b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Global Variables Used: 421b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 422b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 423b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Local Variables Needed: 424b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 425b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 426b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 427b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION DESCRIPTION 428b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 429b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber PURPOSE: Modified quantization of the MR795 codebook gain 430b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 431b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Uses pre-computed energy coefficients in frac_en[]/exp_en[] 432b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 433b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac_en[0]*2^exp_en[0] = <res res> // LP residual energy 434b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac_en[1]*2^exp_en[1] = <exc exc> // LTP residual energy 435b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac_en[2]*2^exp_en[2] = <exc code> // LTP/CB innovation dot product 436b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac_en[3]*2^exp_en[3] = <code code> // CB innovation energy 437b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 438b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REQUIREMENTS 439b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 440b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 441b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 442b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 443b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REFERENCES 444b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 445b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber qgain795.c, UMTS GSM AMR speech codec, R99 - Version 3.2.0, March 2, 2001 446b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 447b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 448b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber PSEUDO-CODE 449b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 450b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 451b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 452b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber RESOURCES USED [optional] 453b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 454b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber When the code is written for a specific target processor the 455b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber the resources used should be documented below. 456b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 457b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber HEAP MEMORY USED: x bytes 458b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 459b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber STACK MEMORY USED: x bytes 460b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 461b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CLOCK CYCLES: (cycle count equation for this function) + (variable 462b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber used to represent cycle count for each subroutine 463b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber called) 464b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber where: (cycle count variable) = cycle count for [subroutine 465b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber name] 466b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 467b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 468b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CAUTION [optional] 469b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber [State any special notes, constraints or cautions for users of this function] 470b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 471b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 472b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber*/ 473b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 474b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huberstatic Word16 475b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas HuberMR795_gain_code_quant_mod( /* o : index of quantization. */ 476b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 gain_pit, /* i : pitch gain, Q14 */ 477b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 exp_gcode0, /* i : predicted CB gain (exponent), Q0 */ 478b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 gcode0, /* i : predicted CB gain (norm.), Q14 */ 479b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 frac_en[], /* i : energy coefficients (4), 480b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber fraction part, Q15 */ 481b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 exp_en[], /* i : energy coefficients (4), 482b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber eponent part, Q0 */ 483b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 alpha, /* i : gain adaptor factor (>0), Q15 */ 484b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 gain_cod_unq, /* i : Code gain (unquantized) */ 485b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* (scaling: Q10 - exp_gcode0) */ 486b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *gain_cod, /* i/o: Code gain (pre-/quantized), Q1 */ 487b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *qua_ener_MR122, /* o : quantized energy error, Q10 */ 488b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* (for MR122 MA predictor update) */ 489b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *qua_ener, /* o : quantized energy error, Q10 */ 490b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* (for other MA predictor update) */ 491b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Flag *pOverflow /* o : overflow indicator */ 492b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber) 493b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 494b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber const Word16 *p; 495b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 i; 496b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 index; 497b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 tmp; 498b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 one_alpha; 499b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 exp; 500b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 e_max; 501b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 502b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 g2_pitch; 503b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 g_code; 504b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 g2_code_h; 505b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 g2_code_l; 506b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 d2_code_h; 507b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 d2_code_l; 508b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 coeff[5]; 509b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 coeff_lo[5]; 510b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 exp_coeff[5]; 511b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 L_tmp; 512b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 L_t0; 513b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 L_t1; 514b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 dist_min; 515b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 gain_code; 516b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 517b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* 518b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Steps in calculation of the error criterion (dist): 519b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber --------------------------------------------------- 520b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 521b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber underlined = constant; alp = FLP value of alpha, alpha = FIP 522b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ---------- 523b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 524b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 525b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ExEn = gp^2 * LtpEn + 2.0*gp*gc[i] * XC + gc[i]^2 * InnEn; 526b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ------------ ------ -- ----- 527b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 528b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber aExEn= alp * ExEn 529b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber = alp*gp^2*LtpEn + 2.0*alp*gp*XC* gc[i] + alp*InnEn* gc[i]^2 530b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber -------------- ------------- --------- 531b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 532b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber = t[1] + t[2] + t[3] 533b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 534b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dist = d1 + d2; 535b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 536b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber d1 = (1.0 - alp) * InnEn * (gcu - gc[i])^2 = t[4] 537b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ------------------- --- 538b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 539b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber d2 = alp * (ResEn - 2.0 * sqrt(ResEn*ExEn) + ExEn); 540b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber --- ----- --- ----- 541b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 542b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber = alp * (sqrt(ExEn) - sqrt(ResEn))^2 543b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber --- ----------- 544b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 545b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber = (sqrt(aExEn) - sqrt(alp*ResEn))^2 546b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber --------------- 547b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 548b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber = (sqrt(aExEn) - t[0] )^2 549b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ---- 550b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 551b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber */ 552b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 553b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* 554b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * calculate scalings of the constant terms 555b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber */ 556b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber gain_code = shl(*gain_cod, sub(10, exp_gcode0, pOverflow), pOverflow); /* Q1 -> Q11 (-ec0) */ 557b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber g2_pitch = mult(gain_pit, gain_pit, pOverflow); /* Q14 -> Q13 */ 558b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* 0 < alpha <= 0.5 => 0.5 <= 1-alpha < 1, i.e one_alpha is normalized */ 559b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber one_alpha = add(sub(32767, alpha, pOverflow), 1, pOverflow); /* 32768 - alpha */ 560b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 561b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 562b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* alpha <= 0.5 -> mult. by 2 to keep precision; compensate in exponent */ 563b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_t1 = L_mult(alpha, frac_en[1], pOverflow); 564b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_t1 = L_shl(L_t1, 1, pOverflow); 565b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tmp = extract_h(L_t1); 566b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 567b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* directly store in 32 bit variable because no further mult. required */ 568b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_t1 = L_mult(tmp, g2_pitch, pOverflow); 569b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_coeff[1] = sub(exp_en[1], 15, pOverflow); 570b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 571b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 572b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tmp = extract_h(L_shl(L_mult(alpha, frac_en[2], pOverflow), 1, pOverflow)); 573b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber coeff[2] = mult(tmp, gain_pit, pOverflow); 574b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp = sub(exp_gcode0, 10, pOverflow); 575b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_coeff[2] = add(exp_en[2], exp, pOverflow); 576b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 577b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 578b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* alpha <= 0.5 -> mult. by 2 to keep precision; compensate in exponent */ 579b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber coeff[3] = extract_h(L_shl(L_mult(alpha, frac_en[3], pOverflow), 1, pOverflow)); 580b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp = sub(shl(exp_gcode0, 1, pOverflow), 7, pOverflow); 581b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_coeff[3] = add(exp_en[3], exp, pOverflow); 582b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 583b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 584b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber coeff[4] = mult(one_alpha, frac_en[3], pOverflow); 585b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_coeff[4] = add(exp_coeff[3], 1, pOverflow); 586b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 587b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 588b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_tmp = L_mult(alpha, frac_en[0], pOverflow); 589b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* sqrt_l returns normalized value and 2*exponent 590b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber -> result = val >> (exp/2) 591b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_coeff holds 2*exponent for c[0] */ 592b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* directly store in 32 bit variable because no further mult. required */ 593b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_t0 = sqrt_l_exp(L_tmp, &exp, pOverflow); /* normalization included in sqrt_l_exp */ 594b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp = add(exp, 47, pOverflow); 595b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_coeff[0] = sub(exp_en[0], exp, pOverflow); 596b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 597b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* 598b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * Determine the maximum exponent occuring in the distance calculation 599b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * and adjust all fractions accordingly (including a safety margin) 600b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * 601b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber */ 602b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 603b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* find max(e[1..4],e[0]+31) */ 604b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber e_max = add(exp_coeff[0], 31, pOverflow); 605b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 1; i <= 4; i++) 606b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 607b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (exp_coeff[i] > e_max) 608b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 609b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber e_max = exp_coeff[i]; 610b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 611b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 612b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 613b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* scale c[1] (requires no further multiplication) */ 614b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tmp = sub(e_max, exp_coeff[1], pOverflow); 615b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_t1 = L_shr(L_t1, tmp, pOverflow); 616b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 617b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* scale c[2..4] (used in Mpy_32_16 in the quantizer loop) */ 618b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 2; i <= 4; i++) 619b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 620b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tmp = sub(e_max, exp_coeff[i], pOverflow); 621b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_tmp = L_deposit_h(coeff[i]); 622b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_tmp = L_shr(L_tmp, tmp, pOverflow); 623b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_Extract(L_tmp, &coeff[i], &coeff_lo[i], pOverflow); 624b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 625b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 626b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* scale c[0] (requires no further multiplication) */ 627b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp = sub(e_max, 31, pOverflow); /* new exponent */ 628b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tmp = sub(exp, exp_coeff[0], pOverflow); 629b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_t0 = L_shr(L_t0, shr(tmp, 1, pOverflow), pOverflow); 630b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* perform correction by 1/sqrt(2) if exponent difference is odd */ 631b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if ((tmp & 0x1) != 0) 632b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 633b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_Extract(L_t0, &coeff[0], &coeff_lo[0], pOverflow); 634b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_t0 = Mpy_32_16(coeff[0], coeff_lo[0], 635b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 23170, pOverflow); /* 23170 Q15 = 1/sqrt(2)*/ 636b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 637b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 638b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* search the quantizer table for the lowest value 639b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber of the search criterion */ 640b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dist_min = MAX_32; 641b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber index = 0; 642b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p = &qua_gain_code[0]; 643b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 644b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 0; i < NB_QUA_CODE; i++) 645b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 646b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber g_code = *p++; /* this is g_fac (Q11) */ 647b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p++; /* skip log2(g_fac) */ 648b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p++; /* skip 20*log10(g_fac) */ 649b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber g_code = mult(g_code, gcode0, pOverflow); 650b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 651b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* only continue if gc[i] < 2.0*gc 652b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber which is equiv. to g_code (Q10-ec0) < gain_code (Q11-ec0) */ 653b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 654b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (g_code >= gain_code) 655b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 656b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber break; 657b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 658b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 659b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_tmp = L_mult(g_code, g_code, pOverflow); 660b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_Extract(L_tmp, &g2_code_h, &g2_code_l, pOverflow); 661b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 662b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tmp = sub(g_code, gain_cod_unq, pOverflow); 663b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_tmp = L_mult(tmp, tmp, pOverflow); 664b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_Extract(L_tmp, &d2_code_h, &d2_code_l, pOverflow); 665b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 666b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* t2, t3, t4 */ 667b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_tmp = Mac_32_16(L_t1, coeff[2], coeff_lo[2], g_code, pOverflow); 668b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_tmp = Mac_32(L_tmp, coeff[3], coeff_lo[3], g2_code_h, g2_code_l, pOverflow); 669b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 670b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_tmp = sqrt_l_exp(L_tmp, &exp, pOverflow); 671b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_tmp = L_shr(L_tmp, shr(exp, 1, pOverflow), pOverflow); 672b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 673b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* d2 */ 674b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tmp = pv_round(L_sub(L_tmp, L_t0, pOverflow), pOverflow); 675b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_tmp = L_mult(tmp, tmp, pOverflow); 676b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 677b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* dist */ 678b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_tmp = Mac_32(L_tmp, coeff[4], coeff_lo[4], d2_code_h, d2_code_l, pOverflow); 679b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 680b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* store table index if distance measure for this 681b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber index is lower than the minimum seen so far */ 682b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (L_tmp < dist_min) 683b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 684b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dist_min = L_tmp; 685b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber index = i; 686b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 687b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 688b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 689b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /*------------------------------------------------------------------* 690b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * read quantized gains and new values for MA predictor memories * 691b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ * 692b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *------------------------------------------------------------------*/ 693b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 694b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* Read the quantized gains */ 695b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p = &qua_gain_code[add(add(index, index, pOverflow), index, pOverflow)]; 696b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber g_code = *p++; 697b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *qua_ener_MR122 = *p++; 698b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *qua_ener = *p; 699b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 700b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /*------------------------------------------------------------------* 701b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * calculate final fixed codebook gain: * 702b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ * 703b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * * 704b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * gc = gc0 * g * 705b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *------------------------------------------------------------------*/ 706b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 707b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_tmp = L_mult(g_code, gcode0, pOverflow); 708b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_tmp = L_shr(L_tmp, sub(9, exp_gcode0, pOverflow), pOverflow); 709b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *gain_cod = extract_h(L_tmp); 710b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 711b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return index; 712b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 713b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 714b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/* 715b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 716b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION NAME: MR795_gain_quant 717b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 718b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber INPUT AND OUTPUT DEFINITIONS 719b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas HuberMR795_gain_quant( 720b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 721b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 722b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Inputs: 723b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber adapt_st -- Pointer to GainAdaptState -- gain adapter state structure 724b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber res -- Word16 array -- LP residual, Q0 725b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exc -- Word16 array -- LTP excitation (unfiltered), Q0 726b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber code -- Word16 array -- CB innovation (unfiltered), Q13 727b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac_coeff -- Word16 array -- coefficients (5), Q15 728b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_coeff -- Word16 array -- energy coefficients (5), Q0 729b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber coefficients from calc_filt_ener() 730b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_code_en -- Word16 -- innovation energy (exponent), Q0 731b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac_code_en -- Word16 -- innovation energy (fraction), Q15 732b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_gcode0 -- Word16 -- predicted CB gain (exponent), Q0 733b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac_gcode0 -- Word16 -- predicted CB gain (fraction), Q15 734b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_subfr -- Word16 -- Subframe length 735b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber cod_gain_frac -- Word16 -- opt. codebook gain (fraction),Q15 736b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber cod_gain_exp -- Word16 -- opt. codebook gain (exponent), Q0 737b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber gp_limit -- Word16 -- pitch gain limit 738b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber gain_pit -- Pointer to Word16 -- Pitch gain, Q14 739b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 740b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Output 741b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber adapt_st -- Pointer to GainAdaptState -- gain adapter state structure 742b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber gain_pit -- Pointer to Word16 -- Pitch gain, Q14 743b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 744b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber gain_pit -- Pointer to Word16 -- Pitch gain, Q14 745b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber gain_cod -- Pointer to Word16 -- Code gain, Q1 746b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber qua_ener_MR122 -- Pointer to Word16 -- quantized energy error, Q10 747b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber (for MR122 MA predictor update) 748b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 749b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber qua_ener -- Pointer to Word16 -- quantized energy error, Q10 750b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber (for other MA predictor update) 751b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 752b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber anap -- Double Pointer to Word16 -- Index of quantization 753b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber (first gain pitch, then code pitch) 754b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 755b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow -- Pointer to Flag -- overflow indicator 756b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 757b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Returns: 758b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 759b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 760b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Global Variables Used: 761b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 762b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 763b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Local Variables Needed: 764b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 765b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 766b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 767b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION DESCRIPTION 768b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 769b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pitch and codebook quantization for MR795 770b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 771b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REQUIREMENTS 772b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 773b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 774b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 775b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 776b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REFERENCES 777b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 778b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber qgain795.c, UMTS GSM AMR speech codec, R99 - Version 3.2.0, March 2, 2001 779b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 780b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 781b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber PSEUDO-CODE 782b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 783b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 784b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 785b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber RESOURCES USED [optional] 786b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 787b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber When the code is written for a specific target processor the 788b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber the resources used should be documented below. 789b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 790b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber HEAP MEMORY USED: x bytes 791b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 792b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber STACK MEMORY USED: x bytes 793b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 794b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CLOCK CYCLES: (cycle count equation for this function) + (variable 795b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber used to represent cycle count for each subroutine 796b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber called) 797b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber where: (cycle count variable) = cycle count for [subroutine 798b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber name] 799b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 800b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 801b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CAUTION [optional] 802b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber [State any special notes, constraints or cautions for users of this function] 803b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 804b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 805b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber*/ 806b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 807b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Hubervoid 808b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas HuberMR795_gain_quant( 809b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber GainAdaptState *adapt_st, /* i/o: gain adapter state structure */ 810b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 res[], /* i : LP residual, Q0 */ 811b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 exc[], /* i : LTP excitation (unfiltered), Q0 */ 812b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 code[], /* i : CB innovation (unfiltered), Q13 */ 813b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 frac_coeff[], /* i : coefficients (5), Q15 */ 814b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 exp_coeff[], /* i : energy coefficients (5), Q0 */ 815b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* coefficients from calc_filt_ener() */ 816b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 exp_code_en, /* i : innovation energy (exponent), Q0 */ 817b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 frac_code_en, /* i : innovation energy (fraction), Q15 */ 818b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 exp_gcode0, /* i : predicted CB gain (exponent), Q0 */ 819b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 frac_gcode0, /* i : predicted CB gain (fraction), Q15 */ 820b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 L_subfr, /* i : Subframe length */ 821b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 cod_gain_frac, /* i : opt. codebook gain (fraction),Q15 */ 822b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 cod_gain_exp, /* i : opt. codebook gain (exponent), Q0 */ 823b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 gp_limit, /* i : pitch gain limit */ 824b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *gain_pit, /* i/o: Pitch gain, Q14 */ 825b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *gain_cod, /* o : Code gain, Q1 */ 826b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *qua_ener_MR122, /* o : quantized energy error, Q10 */ 827b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* (for MR122 MA predictor update) */ 828b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *qua_ener, /* o : quantized energy error, Q10 */ 829b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* (for other MA predictor update) */ 830b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 **anap, /* o : Index of quantization */ 831b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* (first gain pitch, then code pitch)*/ 832b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Flag *pOverflow /* o : overflow indicator */ 833b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber) 834b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 835b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 frac_en[4]; 836b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 exp_en[4]; 837b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 ltpg, alpha, gcode0; 838b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 g_pitch_cand[3]; /* pitch gain candidates Q14 */ 839b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 g_pitch_cind[3]; /* pitch gain indices Q0 */ 840b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 gain_pit_index; 841b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 gain_cod_index; 842b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 exp; 843b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 gain_cod_unq; /* code gain (unq.) Q(10-exp_gcode0) */ 844b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 845b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 846b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* get list of candidate quantized pitch gain values 847b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * and corresponding quantization indices 848b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber */ 849b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber gain_pit_index = q_gain_pitch(MR795, gp_limit, gain_pit, 850b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber g_pitch_cand, g_pitch_cind, pOverflow); 851b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 852b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /*-------------------------------------------------------------------* 853b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * predicted codebook gain * 854b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * ~~~~~~~~~~~~~~~~~~~~~~~ * 855b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * gc0 = 2^exp_gcode0 + 2^frac_gcode0 * 856b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * * 857b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * gcode0 (Q14) = 2^14*2^frac_gcode0 = gc0 * 2^(14-exp_gcode0) * 858b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *-------------------------------------------------------------------*/ 859b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber gcode0 = (Word16)(Pow2(14, frac_gcode0, pOverflow)); /* Q14 */ 860b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 861b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* pre-quantization of codebook gain 862b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * (using three pitch gain candidates); 863b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * result: best guess of pitch gain and code gain 864b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber */ 865b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber MR795_gain_code_quant3( 866b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_gcode0, gcode0, g_pitch_cand, g_pitch_cind, 867b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac_coeff, exp_coeff, 868b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber gain_pit, &gain_pit_index, gain_cod, &gain_cod_index, 869b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber qua_ener_MR122, qua_ener, pOverflow); 870b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 871b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* calculation of energy coefficients and LTP coding gain */ 872b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber calc_unfilt_energies(res, exc, code, *gain_pit, L_subfr, 873b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac_en, exp_en, <pg, pOverflow); 874b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 875b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* run gain adaptor, calculate alpha factor to balance LTP/CB gain 876b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * (this includes the gain adaptor update) 877b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * Note: ltpg = 0 if frac_en[0] == 0, so the update is OK in that case 878b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber */ 879b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber gain_adapt(adapt_st, ltpg, *gain_cod, &alpha, pOverflow); 880b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 881b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* if this is a very low energy signal (threshold: see 882b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * calc_unfilt_energies) or alpha <= 0 then don't run the modified quantizer 883b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber */ 884b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (frac_en[0] != 0 && alpha > 0) 885b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 886b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* innovation energy <cod cod> was already computed in gc_pred() */ 887b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* (this overwrites the LtpResEn which is no longer needed) */ 888b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac_en[3] = frac_code_en; 889b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_en[3] = exp_code_en; 890b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 891b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* store optimum codebook gain in Q(10-exp_gcode0) */ 892b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp = add(sub(cod_gain_exp, exp_gcode0, pOverflow), 10, pOverflow); 893b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber gain_cod_unq = shl(cod_gain_frac, exp, pOverflow); 894b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 895b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* run quantization with modified criterion */ 896b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber gain_cod_index = MR795_gain_code_quant_mod( 897b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *gain_pit, exp_gcode0, gcode0, 898b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac_en, exp_en, alpha, gain_cod_unq, 899b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber gain_cod, qua_ener_MR122, qua_ener, pOverflow); /* function result */ 900b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 901b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 902b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *(*anap)++ = gain_pit_index; 903b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *(*anap)++ = gain_cod_index; 904b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 905