14f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/* ------------------------------------------------------------------ 24f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * Copyright (C) 1998-2009 PacketVideo 34f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 44f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * Licensed under the Apache License, Version 2.0 (the "License"); 54f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * you may not use this file except in compliance with the License. 64f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * You may obtain a copy of the License at 74f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 84f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * http://www.apache.org/licenses/LICENSE-2.0 94f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 104f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * Unless required by applicable law or agreed to in writing, software 114f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * distributed under the License is distributed on an "AS IS" BASIS, 124f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either 134f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * express or implied. 144f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * See the License for the specific language governing permissions 154f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * and limitations under the License. 164f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * ------------------------------------------------------------------- 174f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber */ 184f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/**************************************************************************************** 194f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas HuberPortions of this file are derived from the following 3GPP standard: 204f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 214f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3GPP TS 26.173 224f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ANSI-C code for the Adaptive Multi-Rate - Wideband (AMR-WB) speech codec 234f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Available from http://www.3gpp.org 244f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 254f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber(C) 2007, 3GPP Organizational Partners (ARIB, ATIS, CCSA, ETSI, TTA, TTC) 264f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas HuberPermission to distribute, modify and use this file under the standard license 274f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huberterms listed above has been obtained from the copyright holder. 284f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber****************************************************************************************/ 294f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/* 304f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber------------------------------------------------------------------------------ 314f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 324f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 334f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 344f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Filename: dec_gain2_amr_wb.cpp 354f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 364f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Date: 05/08/2004 374f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 384f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber------------------------------------------------------------------------------ 394f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber REVISION HISTORY 404f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 414f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 424f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Description: 434f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 444f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber------------------------------------------------------------------------------ 454f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber INPUT AND OUTPUT DEFINITIONS 464f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 474f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 index, (i) : index of quantization. 484f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 nbits, (i) : number of bits (6 or 7) 494f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 code[], (i) Q9 : Innovative vector. 504f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 L_subfr, (i) : Subframe lenght. 514f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 * gain_pit, (o) Q14 : Pitch gain. 524f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int32 * gain_cod, (o) Q16 : Code gain. 534f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 bfi, (i) : bad frame indicator 544f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 prev_bfi, (i) : Previous BF indicator 554f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 state, (i) : State of BFH 564f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 unusable_frame, (i) : UF indicator 574f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 vad_hist, (i) : number of non-speech frames 584f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 * mem (i/o) : static memory (4 words) 594f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 604f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber------------------------------------------------------------------------------ 614f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber FUNCTION DESCRIPTION 624f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 634f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Decode the pitch and codebook gains 644f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 654f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber------------------------------------------------------------------------------ 664f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber REQUIREMENTS 674f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 684f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 694f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber------------------------------------------------------------------------------ 704f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber REFERENCES 714f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 724f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber------------------------------------------------------------------------------ 734f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber PSEUDO-CODE 744f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 754f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber------------------------------------------------------------------------------ 764f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber*/ 774f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 784f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 794f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 804f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; INCLUDES 814f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 824f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 834f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 844f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber#include "pv_amr_wb_type_defs.h" 854f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber#include "pvamrwbdecoder_basic_op.h" 864f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber#include "pvamrwb_math_op.h" 874f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber#include "pvamrwbdecoder_cnst.h" 884f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber#include "pvamrwbdecoder_acelp.h" 894f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 904f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber#include "qisf_ns.h" 914f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 924f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 934f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; MACROS 944f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; Define module specific macros here 954f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 964f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 974f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 984f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 994f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; DEFINES 1004f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; Include all pre-processor statements here. Include conditional 1014f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; compile variables also. 1024f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 1034f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1044f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber#define MEAN_ENER 30 1054f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber#define PRED_ORDER 4 1064f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1074f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber#define L_LTPHIST 5 1084f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1094f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 1104f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; LOCAL FUNCTION DEFINITIONS 1114f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; Function Prototype declaration 1124f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 1134f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1144f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 1154f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; LOCAL STORE/BUFFER/POINTER DEFINITIONS 1164f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; Variable declaration - defined here and used outside this module 1174f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 1184f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1194f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huberconst int16 pdown_unusable[7] = {32767, 31130, 29491, 24576, 7537, 1638, 328}; 1204f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huberconst int16 cdown_unusable[7] = {32767, 16384, 8192, 8192, 8192, 4915, 3277}; 1214f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1224f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huberconst int16 pdown_usable[7] = {32767, 32113, 31457, 24576, 7537, 1638, 328}; 1234f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huberconst int16 cdown_usable[7] = {32767, 32113, 32113, 32113, 32113, 32113, 22938}; 1244f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1254f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1264f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/* MA prediction coeff ={0.5, 0.4, 0.3, 0.2} in Q13 */ 1274f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huberconst int16 pred[PRED_ORDER] = {4096, 3277, 2458, 1638}; 1284f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1294f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 1304f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; EXTERNAL FUNCTION REFERENCES 1314f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; Declare functions defined elsewhere and referenced in this module 1324f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 1334f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1344f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 1354f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; EXTERNAL GLOBAL STORE/BUFFER/POINTER REFERENCES 1364f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; Declare variables used in this module but defined elsewhere 1374f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 1384f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1394f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 1404f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; FUNCTION CODE 1414f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 1424f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1434f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1444f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/* output :static memory (4 words) */ 1454f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Hubervoid dec_gain2_amr_wb_init(int16 * mem) 1464f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber{ 1474f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1484f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* 4nd order quantizer energy predictor (init to -14.0 in Q10) */ 1494f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber mem[0] = -14336; /* past_qua_en[0] */ 1504f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber mem[1] = -14336; /* past_qua_en[1] */ 1514f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber mem[2] = -14336; /* past_qua_en[2] */ 1524f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber mem[3] = -14336; /* past_qua_en[3] */ 1534f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* 4 *past_gain_pit */ 1544f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* 5 *past_gain_code */ 1554f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* 6 *prev_gc */ 1564f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* next 5 pbuf[] */ 1574f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* next 5 gbuf[] */ 1584f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* next 5 pbuf2[] */ 1594f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pv_memset((void *)&mem[4], 0, 18*sizeof(*mem)); 1604f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1614f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber mem[22] = 21845; 1624f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1634f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber} 1644f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1654f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 1664f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; FUNCTION CODE 1674f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 1684f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1694f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Hubervoid dec_gain2_amr_wb( 1704f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 index, /* (i) : index of quantization. */ 1714f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 nbits, /* (i) : number of bits (6 or 7) */ 1724f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 code[], /* (i) Q9 : Innovative vector. */ 1734f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 L_subfr, /* (i) : Subframe lenght. */ 1744f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 * gain_pit, /* (o) Q14 : Pitch gain. */ 1754f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int32 * gain_cod, /* (o) Q16 : Code gain. */ 1764f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 bfi, /* (i) : bad frame indicator */ 1774f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 prev_bfi, /* (i) : Previous BF indicator */ 1784f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 state, /* (i) : State of BFH */ 1794f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 unusable_frame, /* (i) : UF indicator */ 1804f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 vad_hist, /* (i) : number of non-speech frames */ 1814f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 * mem /* (i/o) : static memory (4 words) */ 1824f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber) 1834f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber{ 1844f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber const int16 *p; 1854f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 *past_gain_pit, *past_gain_code, *past_qua_en, *gbuf, *pbuf, *prev_gc; 1864f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 *pbuf2; 1874f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 i, tmp, exp, frac, gcode0, exp_gcode0, qua_ener, gcode_inov; 1884f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 tmp1, g_code; 1894f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 tmp2; 1904f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int32 L_tmp; 1914f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1924f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber past_qua_en = mem; 1934f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber past_gain_pit = mem + 4; 1944f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber past_gain_code = mem + 5; 1954f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber prev_gc = mem + 6; 1964f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pbuf = mem + 7; 1974f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber gbuf = mem + 12; 1984f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pbuf2 = mem + 17; 1994f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2004f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* 2014f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * Find energy of code and compute: 2024f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 2034f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * L_tmp = 1.0 / sqrt(energy of code/ L_subfr) 2044f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber */ 2054f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2064f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = Dot_product12(code, code, L_subfr, &exp); 2074f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber exp -= 24; /* exp: -18 (code in Q9), -6 (/L_subfr) */ 2084f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2094f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber one_ov_sqrt_norm(&L_tmp, &exp); 2104f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2114f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber gcode_inov = extract_h(shl_int32(L_tmp, exp - 3)); /* g_code_inov in Q12 */ 2124f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2134f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* 2144f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * Case of erasure. 2154f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber */ 2164f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2174f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (bfi != 0) 2184f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 2194f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber tmp = median5(&pbuf[2]); 2204f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber *past_gain_pit = tmp; 2214f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2224f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (*past_gain_pit > 15565) 2234f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 2244f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber *past_gain_pit = 15565; /* 0.95 in Q14 */ 2254f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2264f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 2274f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2284f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (unusable_frame != 0) 2294f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 2304f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber *gain_pit = mult_int16(pdown_unusable[state], *past_gain_pit); 2314f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 2324f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else 2334f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 2344f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber *gain_pit = mult_int16(pdown_usable[state], *past_gain_pit); 2354f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 2364f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber tmp = median5(&gbuf[2]); 2374f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2384f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (vad_hist > 2) 2394f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 2404f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber *past_gain_code = tmp; 2414f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 2424f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else 2434f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 2444f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2454f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (unusable_frame != 0) 2464f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 2474f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber *past_gain_code = mult_int16(cdown_unusable[state], tmp); 2484f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 2494f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else 2504f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 2514f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber *past_gain_code = mult_int16(cdown_usable[state], tmp); 2524f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 2534f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 2544f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2554f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* update table of past quantized energies */ 2564f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2574f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber tmp = past_qua_en[3]; 2584f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber tmp1 = past_qua_en[2]; 2594f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = tmp; 2604f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp += tmp1; 2614f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber past_qua_en[3] = tmp; 2624f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber tmp = past_qua_en[1]; 2634f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber tmp1 = past_qua_en[0]; 2644f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp += tmp; 2654f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp += tmp1; 2664f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber past_qua_en[2] = tmp; 2674f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber qua_ener = (int16)(L_tmp >> 3); 2684f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber past_qua_en[1] = tmp1; 2694f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2704f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2714f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber qua_ener -= 3072; /* -3 in Q10 */ 2724f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2734f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (qua_ener < -14336) 2744f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 2754f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber qua_ener = -14336; /* -14 in Q10 */ 2764f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 2774f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2784f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber past_qua_en[0] = qua_ener; 2794f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2804f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2814f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = 1; i < 5; i++) 2824f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 2834f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber gbuf[i - 1] = gbuf[i]; 2844f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pbuf[i - 1] = pbuf[i]; 2854f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 2864f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber gbuf[4] = *past_gain_code; 2874f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pbuf[4] = *past_gain_pit; 2884f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2894f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2904f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* adjust gain according to energy of code */ 2914f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* past_gain_code(Q3) * gcode_inov(Q12) => Q16 */ 2924f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber *gain_cod = mul_16by16_to_int32(*past_gain_code, gcode_inov); 2934f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2944f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber return; 2954f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 2964f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* 2974f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * Compute gcode0 2984f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * = Sum(i=0,1) pred[i]*past_qua_en[i] + mean_ener - ener_code 2994f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber */ 3004f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3014f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = L_deposit_h(MEAN_ENER); /* MEAN_ENER in Q16 */ 3024f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = shl_int32(L_tmp, 8); /* From Q16 to Q24 */ 3034f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = mac_16by16_to_int32(L_tmp, pred[0], past_qua_en[0]); /* Q13*Q10 -> Q24 */ 3044f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = mac_16by16_to_int32(L_tmp, pred[1], past_qua_en[1]); /* Q13*Q10 -> Q24 */ 3054f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = mac_16by16_to_int32(L_tmp, pred[2], past_qua_en[2]); /* Q13*Q10 -> Q24 */ 3064f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = mac_16by16_to_int32(L_tmp, pred[3], past_qua_en[3]); /* Q13*Q10 -> Q24 */ 3074f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3084f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber gcode0 = extract_h(L_tmp); /* From Q24 to Q8 */ 3094f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3104f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* 3114f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * gcode0 = pow(10.0, gcode0/20) 3124f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * = pow(2, 3.321928*gcode0/20) 3134f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * = pow(2, 0.166096*gcode0) 3144f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber */ 3154f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3164f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = ((int32)gcode0 * 5443) >> 7; /* *0.166096 in Q15 -> Q24 */ 3174f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3184f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int32_to_dpf(L_tmp, &exp_gcode0, &frac); /* Extract exponant of gcode0 */ 3194f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3204f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber gcode0 = (int16)(power_of_2(14, frac)); /* Put 14 as exponant so that */ 3214f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* output of Pow2() will be: */ 3224f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* 16384 < Pow2() <= 32767 */ 3234f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber exp_gcode0 -= 14; 3244f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3254f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Read the quantized gains */ 3264f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3274f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (nbits == 6) 3284f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 3294f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber p = &t_qua_gain6b[index<<1]; 3304f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 3314f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else 3324f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 3334f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber p = &t_qua_gain7b[index<<1]; 3344f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 3354f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber *gain_pit = *p++; /* selected pitch gain in Q14 */ 3364f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber g_code = *p++; /* selected code gain in Q11 */ 3374f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3384f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = mul_16by16_to_int32(g_code, gcode0); /* Q11*Q0 -> Q12 */ 3394f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = shl_int32(L_tmp, exp_gcode0 + 4); /* Q12 -> Q16 */ 3404f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3414f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber *gain_cod = L_tmp; /* gain of code in Q16 */ 3424f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3434f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (prev_bfi == 1) 3444f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 3454f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = mul_16by16_to_int32(*prev_gc, 5120); /* prev_gc(Q3) * 1.25(Q12) = Q16 */ 3464f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* if((*gain_cod > ((*prev_gc) * 1.25)) && (*gain_cod > 100.0)) */ 3474f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3484f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if ((*gain_cod > L_tmp) && (*gain_cod > 6553600)) 3494f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 3504f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber *gain_cod = L_tmp; 3514f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 3524f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 3534f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* keep past gain code in Q3 for frame erasure (can saturate) */ 3544f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber *past_gain_code = amr_wb_round(shl_int32(*gain_cod, 3)); 3554f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber *past_gain_pit = *gain_pit; 3564f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3574f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3584f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber *prev_gc = *past_gain_code; 3594f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber tmp = gbuf[1]; 3604f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber tmp1 = pbuf[1]; 3614f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber tmp2 = pbuf2[1]; 3624f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = 1; i < 5; i++) 3634f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 3644f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber gbuf[i - 1] = tmp; 3654f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pbuf[i - 1] = tmp1; 3664f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pbuf2[i - 1] = tmp2; 3674f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber tmp = gbuf[i]; 3684f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber tmp1 = pbuf[i]; 3694f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber tmp2 = pbuf2[i]; 3704f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 3714f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber gbuf[4] = *past_gain_code; 3724f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pbuf[4] = *past_gain_pit; 3734f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pbuf2[4] = *past_gain_pit; 3744f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3754f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3764f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* adjust gain according to energy of code */ 3774f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int32_to_dpf(*gain_cod, &exp, &frac); 3784f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = mul_32by16(exp, frac, gcode_inov); 3794f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3804f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber *gain_cod = shl_int32(L_tmp, 3); /* gcode_inov in Q12 */ 3814f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3824f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3834f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber past_qua_en[3] = past_qua_en[2]; 3844f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber past_qua_en[2] = past_qua_en[1]; 3854f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber past_qua_en[1] = past_qua_en[0]; 3864f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3874f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* 3884f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * qua_ener = 20*log10(g_code) 3894f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * = 6.0206*log2(g_code) 3904f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * = 6.0206*(log2(g_codeQ11) - 11) 3914f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber */ 3924f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = (int32)g_code; 3934f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber amrwb_log_2(L_tmp, &exp, &frac); 3944f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber exp -= 11; 3954f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = mul_32by16(exp, frac, 24660); /* x 6.0206 in Q12 */ 3964f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3974f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* update table of past quantized energies */ 3984f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3994f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber past_qua_en[0] = (int16)(L_tmp >> 3); /* result in Q10 */ 4004f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4014f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber return; 4024f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber} 4034f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4044f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 405