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/calc_en.c 35b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Funtions: calc_unfilt_energies 36b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber calc_filt_energies 37b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber calc_target_energy 38b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 39b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 40b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber MODULE DESCRIPTION 41b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 42b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber This file contains the functions that calculate the energy coefficients 43b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for unfiltered and filtered excitation signals, the LTP coding gain, and 44b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber the target energy. 45b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 46b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 47b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber*/ 48b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 49b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 50b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 51b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; INCLUDES 52b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 53b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 54b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "calc_en.h" 55b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "typedef.h" 56b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "basicop_malloc.h" 57b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "l_comp.h" 58b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "cnst.h" 59b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "log2.h" 60b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "basic_op.h" 61b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 62b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 63b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; MACROS 64b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; Define module specific macros here 65b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 66b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 67b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 68b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 69b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; DEFINES 70b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; Include all pre-processor statements here. Include conditional 71b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; compile variables also. 72b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 73b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 74b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 75b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 76b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; LOCAL FUNCTION DEFINITIONS 77b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; Function Prototype declaration 78b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 79b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 80b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 81b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; LOCAL VARIABLE DEFINITIONS 82b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; Variable declaration - defined here and used outside this module 83b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 84b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 85b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 86b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/* 87b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 88b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION NAME: calc_unfilt_energies 89b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 90b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber INPUT AND OUTPUT DEFINITIONS 91b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 92b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Inputs: 93b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber res = LP residual, buffer type Word16 94b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exc = LTP excitation (unfiltered), buffer type Word16 95b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber code = CB innovation (unfiltered), buffer type Word16 96b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber gain_pit = pitch gain, type Word16 97b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_subfr = Subframe length, type Word16 98b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac_en = energy coefficients (4), fraction part, buffer type Word16 99b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_en = energy coefficients (4), exponent part, buffer type Word16 100b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ltpg = LTP coding gain (log2()), pointer to type Word16 101b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow= pointer to value indicating existence of overflow (Flag) 102b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 103b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Outputs: 104b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac_en buffer containing new fractional parts of energy coefficients 105b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_en buffer containing new exponential parts of energy coefficients 106b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ltpg points to new LTP coding gain 107b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow = 1 if there is an overflow else it is zero. 108b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 109b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Returns: 110b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None. 111b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 112b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Global Variables Used: 113b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 114b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 115b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Local Variables Needed: 116b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 117b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 118b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 119b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION DESCRIPTION 120b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 121b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber This function calculates several energy coefficients for unfiltered 122b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber excitation signals and the LTP coding gain 123b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 124b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac_en[0]*2^exp_en[0] = <res res> LP residual energy 125b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac_en[1]*2^exp_en[1] = <exc exc> LTP residual energy 126b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac_en[2]*2^exp_en[2] = <exc code> LTP/CB innovation dot product 127b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac_en[3]*2^exp_en[3] = <lres lres> LTP residual energy 128b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber (lres = res - gain_pit*exc) 129b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ltpg = log2(LP_res_en / LTP_res_en) 130b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 131b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 132b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REQUIREMENTS 133b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 134b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None. 135b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 136b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 137b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REFERENCES 138b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 139b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber calc_en.c, UMTS GSM AMR speech codec, R99 - Version 3.2.0, March 2, 2001 140b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 141b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 142b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber PSEUDO-CODE 143b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 144b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Hubervoid 145b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Hubercalc_unfilt_energies( 146b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 res[], // i : LP residual, Q0 147b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 exc[], // i : LTP excitation (unfiltered), Q0 148b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 code[], // i : CB innovation (unfiltered), Q13 149b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 gain_pit, // i : pitch gain, Q14 150b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 L_subfr, // i : Subframe length 151b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 152b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 frac_en[], // o : energy coefficients (4), fraction part, Q15 153b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 exp_en[], // o : energy coefficients (4), exponent part, Q0 154b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *ltpg // o : LTP coding gain (log2()), Q13 155b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber) 156b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 157b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 s, L_temp; 158b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 i, exp, tmp; 159b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 ltp_res_en, pred_gain; 160b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 ltpg_exp, ltpg_frac; 161b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 162b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // Compute residual energy 163b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = L_mac((Word32) 0, res[0], res[0]); 164b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 1; i < L_subfr; i++) 165b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = L_mac(s, res[i], res[i]); 166b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 167b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // ResEn := 0 if ResEn < 200.0 (= 400 Q1) 168b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (L_sub (s, 400L) < 0) 169b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 170b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac_en[0] = 0; 171b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_en[0] = -15; 172b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 173b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 174b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 175b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp = norm_l(s); 176b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac_en[0] = extract_h(L_shl(s, exp)); 177b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_en[0] = sub(15, exp); 178b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 179b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 180b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // Compute ltp excitation energy 181b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = L_mac((Word32) 0, exc[0], exc[0]); 182b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 1; i < L_subfr; i++) 183b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = L_mac(s, exc[i], exc[i]); 184b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 185b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp = norm_l(s); 186b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac_en[1] = extract_h(L_shl(s, exp)); 187b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_en[1] = sub(15, exp); 188b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 189b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // Compute scalar product <exc[],code[]> 190b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = L_mac((Word32) 0, exc[0], code[0]); 191b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 1; i < L_subfr; i++) 192b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = L_mac(s, exc[i], code[i]); 193b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 194b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp = norm_l(s); 195b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac_en[2] = extract_h(L_shl(s, exp)); 196b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_en[2] = sub(16-14, exp); 197b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 198b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // Compute energy of LTP residual 199b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = 0L; 200b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 0; i < L_subfr; i++) 201b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 202b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_temp = L_mult(exc[i], gain_pit); 203b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_temp = L_shl(L_temp, 1); 204b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tmp = sub(res[i], pv_round(L_temp)); // LTP residual, Q0 205b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = L_mac (s, tmp, tmp); 206b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 207b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 208b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp = norm_l(s); 209b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ltp_res_en = extract_h (L_shl (s, exp)); 210b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp = sub (15, exp); 211b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 212b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac_en[3] = ltp_res_en; 213b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_en[3] = exp; 214b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 215b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // calculate LTP coding gain, i.e. energy reduction LP res -> LTP res 216b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (ltp_res_en > 0 && frac_en[0] != 0) 217b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 218b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // gain = ResEn / LTPResEn 219b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pred_gain = div_s (shr (frac_en[0], 1), ltp_res_en); 220b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp = sub (exp, exp_en[0]); 221b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 222b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // L_temp = ltpGain * 2^(30 + exp) 223b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_temp = L_deposit_h (pred_gain); 224b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // L_temp = ltpGain * 2^27 225b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_temp = L_shr (L_temp, add (exp, 3)); 226b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 227b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // Log2 = log2() + 27 228b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Log2(L_temp, <pg_exp, <pg_frac); 229b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 230b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // ltpg = log2(LtpGain) * 2^13 --> range: +- 4 = +- 12 dB 231b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_temp = L_Comp (sub (ltpg_exp, 27), ltpg_frac); 232b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *ltpg = pv_round (L_shl (L_temp, 13)); // Q13 233b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 234b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 235b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 236b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *ltpg = 0; 237b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 238b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 239b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 240b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 241b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 242b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber RESOURCES USED [optional] 243b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 244b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber When the code is written for a specific target processor the 245b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber the resources used should be documented below. 246b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 247b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber HEAP MEMORY USED: x bytes 248b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 249b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber STACK MEMORY USED: x bytes 250b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 251b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CLOCK CYCLES: (cycle count equation for this function) + (variable 252b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber used to represent cycle count for each subroutine 253b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber called) 254b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber where: (cycle count variable) = cycle count for [subroutine 255b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber name] 256b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 257b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 258b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CAUTION [optional] 259b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber [State any special notes, constraints or cautions for users of this function] 260b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 261b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 262b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber*/ 263b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 264b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Hubervoid calc_unfilt_energies( 265b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 res[], /* i : LP residual, Q0 */ 266b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 exc[], /* i : LTP excitation (unfiltered), Q0 */ 267b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 code[], /* i : CB innovation (unfiltered), Q13 */ 268b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 gain_pit, /* i : pitch gain, Q14 */ 269b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 L_subfr, /* i : Subframe length */ 270b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 271b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 frac_en[], /* o : energy coefficients (4), fraction part, Q15 */ 272b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 exp_en[], /* o : energy coefficients (4), exponent part, Q0 */ 273b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *ltpg, /* o : LTP coding gain (log2()), Q13 */ 274b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Flag *pOverflow 275b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber) 276b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 277b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 s1; /* Intermediate energy accumulator */ 278b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 s2; /* Intermediate energy accumulator */ 279b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 s3; /* Intermediate energy accumulator */ 280b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 s4; /* Intermediate energy accumulator */ 281b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 L_temp; /* temporal 32 bits storage */ 282b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 283b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 i; /* index used in all loops */ 284b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 exp; /* nunmber of '0's or '1's before MSB != 0 */ 285b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 tmp1; /* temporal storage */ 286b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 tmp2; /* temporal storage */ 287b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 ltp_res_en; 288b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 pred_gain; /* predictor gain */ 289b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 ltpg_exp; /* LTP gain (exponent) */ 290b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 ltpg_frac; /* LTP gain (mantissa or fractional part) */ 291b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 292b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s1 = 0; 293b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s2 = 0; 294b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s3 = 0; 295b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s4 = 0; 296b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 297b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /*---------------------------------------------------------------------------- 298b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber NOTE: Overflow is expected as a result of multiply and accumulated without 299b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scale down the inputs. This modification is not made at this point 300b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber to have bit exact results with the pre-optimization code. (JT 6/20/00) 301b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 302b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ----------------------------------------------------------------------------*/ 303b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 304b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 0; i < L_subfr; i++) 305b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 306b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tmp1 = res[i]; /* avoid multiple accesses to memory */ 307b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tmp2 = exc[i]; 308b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 309b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s1 = amrnb_fxp_mac_16_by_16bb((Word32) tmp1, (Word32) tmp1, s1); /* Compute residual energy */ 310b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s2 = amrnb_fxp_mac_16_by_16bb((Word32) tmp2, (Word32) tmp2, s2); /* Compute ltp excitation energy */ 311b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s3 = amrnb_fxp_mac_16_by_16bb((Word32) tmp2, (Word32) code[i], s3);/* Compute scalar product */ 312b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* <exc[],code[]> */ 313b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 314b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_temp = L_mult(tmp2, gain_pit, pOverflow); 315b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_temp = L_shl(L_temp, 1, pOverflow); 316b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tmp2 = sub(tmp1, pv_round(L_temp, pOverflow), pOverflow); 317b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* LTP residual, Q0 */ 318b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s4 = L_mac(s4, tmp2, tmp2, pOverflow); 319b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* Compute energy of LTP residual */ 320b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 321b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s1 = s1 << 1; 322b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s2 = s2 << 1; 323b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s3 = s3 << 1; 324b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 325b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (s1 & MIN_32) 326b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 327b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s1 = MAX_32; 328b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *pOverflow = 1; 329b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 330b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 331b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* ResEn := 0 if ResEn < 200.0 (= 400 Q1) */ 332b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (s1 < 400L) 333b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 334b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac_en[0] = 0; 335b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_en[0] = -15; 336b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 337b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 338b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 339b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp = norm_l(s1); 340b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac_en[0] = (Word16)(L_shl(s1, exp, pOverflow) >> 16); 341b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_en[0] = (15 - exp); 342b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 343b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 344b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (s2 & MIN_32) 345b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 346b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s2 = MAX_32; 347b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *pOverflow = 1; 348b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 349b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 350b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp = norm_l(s2); 351b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac_en[1] = (Word16)(L_shl(s2, exp, pOverflow) >> 16); 352b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_en[1] = sub(15, exp, pOverflow); 353b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 354b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* s3 is not always sum of squares */ 355b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp = norm_l(s3); 356b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac_en[2] = (Word16)(L_shl(s3, exp, pOverflow) >> 16); 357b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_en[2] = 2 - exp; 358b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 359b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp = norm_l(s4); 360b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ltp_res_en = (Word16)(L_shl(s4, exp, pOverflow) >> 16); 361b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp = sub(15, exp, pOverflow); 362b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 363b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac_en[3] = ltp_res_en; 364b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_en[3] = exp; 365b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 366b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* calculate LTP coding gain, i.e. energy reduction LP res -> LTP res */ 367b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 368b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (ltp_res_en > 0 && frac_en[0] != 0) 369b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 370b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* gain = ResEn / LTPResEn */ 371b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pred_gain = div_s(shr(frac_en[0], 1, pOverflow), ltp_res_en); 372b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp = sub(exp, exp_en[0], pOverflow); 373b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 374b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* L_temp = ltpGain * 2^(30 + exp) */ 375b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_temp = (Word32) pred_gain << 16; 376b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* L_temp = ltpGain * 2^27 */ 377b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_temp = L_shr(L_temp, (Word16)(exp + 3), pOverflow); 378b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 379b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* Log2 = log2() + 27 */ 380b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Log2(L_temp, <pg_exp, <pg_frac, pOverflow); 381b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 382b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* ltpg = log2(LtpGain) * 2^13 --> range: +- 4 = +- 12 dB */ 383b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_temp = L_Comp(sub(ltpg_exp, 27, pOverflow), ltpg_frac, pOverflow); 384b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *ltpg = pv_round(L_shl(L_temp, 13, pOverflow), pOverflow); /* Q13 */ 385b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 386b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 387b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 388b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *ltpg = 0; 389b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 390b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 391b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return; 392b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 393b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 394b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/****************************************************************************/ 395b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 396b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 397b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/* 398b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 399b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION NAME: calc_filt_energies 400b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 401b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber INPUT AND OUTPUT DEFINITIONS 402b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 403b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Inputs: 404b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber mode = coder mode, type Mode 405b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber xn = LTP target vector, buffer type Word16 406b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber xn2 = CB target vector, buffer type Word16 407b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber y1 = Adaptive codebook, buffer type Word16 408b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Y2 = Filtered innovative vector, buffer type Word16 409b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber g_coeff = Correlations <xn y1> <y1 y1> 410b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber computed in G_pitch() buffer type Word16 411b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac_coeff = energy coefficients (5), fraction part, buffer type Word16 412b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_coeff = energy coefficients (5), exponent part, buffer type Word16 413b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber cod_gain_frac = optimum codebook gain (fraction part), pointer type Word16 414b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber cod_gain_exp = optimum codebook gain (exponent part), pointer type Word16 415b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow = pointer to overflow indicator (Flag) 416b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 417b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Outputs: 418b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac_coeff contains new fraction part energy coefficients 419b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_coeff contains new exponent part energy coefficients 420b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber cod_gain_frac points to the new optimum codebook gain (fraction part) 421b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber cod_gain_exp points to the new optimum codebook gain (exponent part) 422b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow = 1 if there is an overflow else it is zero. 423b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 424b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Returns: 425b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None. 426b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 427b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Global Variables Used: 428b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 429b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 430b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Local Variables Needed: 431b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 432b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 433b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 434b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION DESCRIPTION 435b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 436b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber This function calculates several energy coefficients for filtered 437b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber excitation signals 438b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 439b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Compute coefficients need for the quantization and the optimum 440b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber codebook gain gcu (for MR475 only). 441b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 442b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber coeff[0] = y1 y1 443b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber coeff[1] = -2 xn y1 444b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber coeff[2] = y2 y2 445b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber coeff[3] = -2 xn y2 446b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber coeff[4] = 2 y1 y2 447b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 448b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber gcu = <xn2, y2> / <y2, y2> (0 if <xn2, y2> <= 0) 449b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 450b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Product <y1 y1> and <xn y1> have been computed in G_pitch() and 451b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber are in vector g_coeff[]. 452b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 453b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 454b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REQUIREMENTS 455b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 456b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None. 457b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 458b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 459b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REFERENCES 460b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 461b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber calc_en.c, UMTS GSM AMR speech codec, R99 - Version 3.2.0, March 2, 2001 462b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 463b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 464b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber PSEUDO-CODE 465b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 466b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Hubervoid 467b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Hubercalc_filt_energies( 468b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber enum Mode mode, // i : coder mode 469b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 xn[], // i : LTP target vector, Q0 470b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 xn2[], // i : CB target vector, Q0 471b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 y1[], // i : Adaptive codebook, Q0 472b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 Y2[], // i : Filtered innovative vector, Q12 473b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 g_coeff[], // i : Correlations <xn y1> <y1 y1> 474b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // computed in G_pitch() 475b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 476b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 frac_coeff[],// o : energy coefficients (5), fraction part, Q15 477b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 exp_coeff[], // o : energy coefficients (5), exponent part, Q0 478b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *cod_gain_frac,// o: optimum codebook gain (fraction part), Q15 479b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *cod_gain_exp // o: optimum codebook gain (exponent part), Q0 480b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber) 481b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 482b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 s, ener_init; 483b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 i, exp, frac; 484b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 y2[L_SUBFR]; 485b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 486b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (sub(mode, MR795) == 0 || sub(mode, MR475) == 0) 487b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 488b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ener_init = 0L; 489b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 490b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 491b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 492b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ener_init = 1L; 493b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 494b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 495b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 0; i < L_SUBFR; i++) { 496b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber y2[i] = shr(Y2[i], 3); 497b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 498b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 499b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac_coeff[0] = g_coeff[0]; 500b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_coeff[0] = g_coeff[1]; 501b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac_coeff[1] = negate(g_coeff[2]); // coeff[1] = -2 xn y1 502b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_coeff[1] = add(g_coeff[3], 1); 503b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 504b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 505b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // Compute scalar product <y2[],y2[]> 506b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 507b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = L_mac(ener_init, y2[0], y2[0]); 508b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 1; i < L_SUBFR; i++) 509b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = L_mac(s, y2[i], y2[i]); 510b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 511b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp = norm_l(s); 512b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac_coeff[2] = extract_h(L_shl(s, exp)); 513b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_coeff[2] = sub(15 - 18, exp); 514b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 515b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // Compute scalar product -2*<xn[],y2[]> 516b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 517b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = L_mac(ener_init, xn[0], y2[0]); 518b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 1; i < L_SUBFR; i++) 519b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = L_mac(s, xn[i], y2[i]); 520b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 521b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp = norm_l(s); 522b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac_coeff[3] = negate(extract_h(L_shl(s, exp))); 523b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_coeff[3] = sub(15 - 9 + 1, exp); 524b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 525b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 526b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // Compute scalar product 2*<y1[],y2[]> 527b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 528b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = L_mac(ener_init, y1[0], y2[0]); 529b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 1; i < L_SUBFR; i++) 530b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = L_mac(s, y1[i], y2[i]); 531b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 532b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp = norm_l(s); 533b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac_coeff[4] = extract_h(L_shl(s, exp)); 534b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_coeff[4] = sub(15 - 9 + 1, exp); 535b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 536b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (sub(mode, MR475) == 0 || sub(mode, MR795) == 0) 537b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 538b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // Compute scalar product <xn2[],y2[]> 539b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 540b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = L_mac(ener_init, xn2[0], y2[0]); 541b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 1; i < L_SUBFR; i++) 542b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = L_mac(s, xn2[i], y2[i]); 543b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 544b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp = norm_l(s); 545b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac = extract_h(L_shl(s, exp)); 546b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp = sub(15 - 9, exp); 547b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 548b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 549b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (frac <= 0) 550b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 551b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *cod_gain_frac = 0; 552b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *cod_gain_exp = 0; 553b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 554b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 555b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 556b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // 557b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber gcu = <xn2, y2> / c[2] 558b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber = (frac>>1)/frac[2] * 2^(exp+1-exp[2]) 559b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber = div_s(frac>>1, frac[2])*2^-15 * 2^(exp+1-exp[2]) 560b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber = div_s * 2^(exp-exp[2]-14) 561b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 562b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *cod_gain_frac = div_s (shr (frac,1), frac_coeff[2]); 563b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *cod_gain_exp = sub (sub (exp, exp_coeff[2]), 14); 564b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 565b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 566b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 567b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 568b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 569b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 570b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber RESOURCES USED [optional] 571b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 572b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber When the code is written for a specific target processor the 573b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber the resources used should be documented below. 574b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 575b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber HEAP MEMORY USED: x bytes 576b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 577b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber STACK MEMORY USED: x bytes 578b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 579b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CLOCK CYCLES: (cycle count equation for this function) + (variable 580b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber used to represent cycle count for each subroutine 581b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber called) 582b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber where: (cycle count variable) = cycle count for [subroutine 583b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber name] 584b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 585b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 586b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CAUTION [optional] 587b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber [State any special notes, constraints or cautions for users of this function] 588b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 589b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 590b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber*/ 591b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 592b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Hubervoid calc_filt_energies( 593b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber enum Mode mode, /* i : coder mode */ 594b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 xn[], /* i : LTP target vector, Q0 */ 595b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 xn2[], /* i : CB target vector, Q0 */ 596b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 y1[], /* i : Adaptive codebook, Q0 */ 597b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 Y2[], /* i : Filtered innovative vector, Q12 */ 598b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 g_coeff[], /* i : Correlations <xn y1> <y1 y1> */ 599b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* computed in G_pitch() */ 600b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 frac_coeff[], /* o : energy coefficients (5), fraction part, Q15 */ 601b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 exp_coeff[], /* o : energy coefficients (5), exponent part, Q0 */ 602b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *cod_gain_frac, /* o : optimum codebook gain (fraction part),Q15 */ 603b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *cod_gain_exp, /* o : optimum codebook gain (exponent part), Q0 */ 604b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Flag *pOverflow 605b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber) 606b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 607b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 s1; /* Intermediate energy accumulator */ 608b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 s2; /* Intermediate energy accumulator */ 609b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 s3; /* Intermediate energy accumulator */ 610b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 611b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 i; /* index used in all loops */ 612b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 exp; /* number of '0's or '1's before MSB != 0 */ 613b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 frac; /* fractional part */ 614b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 tmp; /* temporal storage */ 615b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 scaled_y2[L_SUBFR]; 616b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 617b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 618b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac_coeff[0] = g_coeff[0]; 619b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_coeff[0] = g_coeff[1]; 620b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac_coeff[1] = negate(g_coeff[2]); /* coeff[1] = -2 xn y1 */ 621b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_coeff[1] = add(g_coeff[3], 1, pOverflow); 622b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 623b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if ((mode == MR795) || (mode == MR475)) 624b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 625b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s1 = 0L; 626b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s2 = 0L; 627b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s3 = 0L; 628b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 629b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 630b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 631b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s1 = 1L; 632b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s2 = 1L; 633b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s3 = 1L; 634b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 635b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 636b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 0; i < L_SUBFR; i++) 637b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 638b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* avoid multiple accesses to memory */ 639b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tmp = (Y2[i] >> 3); 640b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scaled_y2[i] = tmp; 641b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 642b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* Compute scalar product <scaled_y2[],scaled_y2[]> */ 643b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s1 = L_mac(s1, tmp, tmp, pOverflow); 644b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 645b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* Compute scalar product -2*<xn[],scaled_y2[]> */ 646b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s2 = L_mac(s2, xn[i], tmp, pOverflow); 647b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 648b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* Compute scalar product 2*<y1[],scaled_y2[]> */ 649b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s3 = L_mac(s3, y1[i], tmp, pOverflow); 650b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 651b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 652b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp = norm_l(s1); 653b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac_coeff[2] = (Word16)(L_shl(s1, exp, pOverflow) >> 16); 654b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_coeff[2] = (-3 - exp); 655b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 656b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp = norm_l(s2); 657b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac_coeff[3] = negate((Word16)(L_shl(s2, exp, pOverflow) >> 16)); 658b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_coeff[3] = (7 - exp); 659b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 660b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp = norm_l(s3); 661b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac_coeff[4] = (Word16)(L_shl(s3, exp, pOverflow) >> 16); 662b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp_coeff[4] = sub(7, exp, pOverflow); 663b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 664b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 665b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if ((mode == MR795) || (mode == MR475)) 666b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 667b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* Compute scalar product <xn2[],scaled_y2[]> */ 668b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s1 = 0L; 669b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 670b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 0; i < L_SUBFR; i++) 671b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 672b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s1 = amrnb_fxp_mac_16_by_16bb((Word32) xn2[i], (Word32)scaled_y2[i], s1); 673b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 674b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 675b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s1 = s1 << 1; 676b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 677b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp = norm_l(s1); 678b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac = (Word16)(L_shl(s1, exp, pOverflow) >> 16); 679b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp = (6 - exp); 680b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 681b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (frac <= 0) 682b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 683b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *cod_gain_frac = 0; 684b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *cod_gain_exp = 0; 685b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 686b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 687b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 688b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* 689b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber gcu = <xn2, scaled_y2> / c[2] 690b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber = (frac>>1)/frac[2] * 2^(exp+1-exp[2]) 691b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber = div_s(frac>>1, frac[2])*2^-15 * 2^(exp+1-exp[2]) 692b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber = div_s * 2^(exp-exp[2]-14) 693b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber */ 694b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *cod_gain_frac = div_s(shr(frac, 1, pOverflow), frac_coeff[2]); 695b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *cod_gain_exp = ((exp - exp_coeff[2]) - 14); 696b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 697b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 698b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 699b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return; 700b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 701b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 702b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/****************************************************************************/ 703b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 704b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/* 705b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 706b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION NAME: calc_target_energy 707b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 708b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber INPUT AND OUTPUT DEFINITIONS 709b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 710b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Inputs: 711b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber xn = LTP target vector, buffer to type Word16 Q0 712b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber en_exp = optimum codebook gain (exponent part) pointer to type Word16 713b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber en_frac = optimum codebook gain (fraction part) pointer to type Word16 714b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow = pointer to overflow indicator (Flag) 715b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 716b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Outputs: 717b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber en_exp points to new optimum codebook gain (exponent part) 718b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber en_frac points to new optimum codebook gain (fraction part) 719b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow = 1 if there is an overflow else it is zero. 720b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 721b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Returns: 722b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None. 723b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 724b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Global Variables Used: 725b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 726b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 727b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Local Variables Needed: 728b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 729b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 730b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 731b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION DESCRIPTION 732b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 733b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber This function calculates the target energy using the formula, 734b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber en = <xn, xn> 735b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 736b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 737b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REQUIREMENTS 738b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 739b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None. 740b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 741b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 742b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REFERENCES 743b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 744b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber calc_en.c, UMTS GSM AMR speech codec, R99 - Version 3.2.0, March 2, 2001 745b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 746b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 747b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber PSEUDO-CODE 748b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 749b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Hubervoid 750b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Hubercalc_target_energy( 751b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 xn[], // i: LTP target vector, Q0 752b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *en_exp, // o: optimum codebook gain (exponent part), Q0 753b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *en_frac // o: optimum codebook gain (fraction part), Q15 754b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber) 755b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 756b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 s; 757b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 i, exp; 758b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 759b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // Compute scalar product <xn[], xn[]> 760b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = L_mac(0L, xn[0], xn[0]); 761b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 1; i < L_SUBFR; i++) 762b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = L_mac(s, xn[i], xn[i]); 763b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 764b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // s = SUM 2*xn(i) * xn(i) = <xn xn> * 2 765b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp = norm_l(s); 766b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *en_frac = extract_h(L_shl(s, exp)); 767b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *en_exp = sub(16, exp); 768b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 769b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 770b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 771b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber RESOURCES USED [optional] 772b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 773b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber When the code is written for a specific target processor the 774b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber the resources used should be documented below. 775b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 776b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber HEAP MEMORY USED: x bytes 777b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 778b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber STACK MEMORY USED: x bytes 779b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 780b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CLOCK CYCLES: (cycle count equation for this function) + (variable 781b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber used to represent cycle count for each subroutine 782b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber called) 783b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber where: (cycle count variable) = cycle count for [subroutine 784b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber name] 785b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 786b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 787b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CAUTION [optional] 788b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber [State any special notes, constraints or cautions for users of this function] 789b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 790b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 791b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber*/ 792b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 793b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Hubervoid calc_target_energy( 794b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 xn[], /* i: LTP target vector, Q0 */ 795b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *en_exp, /* o: optimum codebook gain (exponent part), Q0 */ 796b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *en_frac, /* o: optimum codebook gain (fraction part), Q15 */ 797b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Flag *pOverflow 798b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber) 799b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 800b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 s; /* Intermediate energy accumulator */ 801b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 i; /* index used in all loops */ 802b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 exp; 803b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 804b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* Compute scalar product <xn[], xn[]> */ 805b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = 0; 806b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 0; i < L_SUBFR; i++) 807b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 808b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = amrnb_fxp_mac_16_by_16bb((Word32) xn[i], (Word32) xn[i], s); 809b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 810b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 811b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (s < 0) 812b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 813b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *pOverflow = 1; 814b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = MAX_32; 815b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 816b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 817b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* s = SUM 2*xn(i) * xn(i) = <xn xn> * 2 */ 818b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exp = norm_l(s); 819b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *en_frac = (Word16)(L_shl(s, exp, pOverflow) >> 16); 820b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *en_exp = (16 - exp); 821b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 822b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return; 823b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 824b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 825b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 826