1a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/* ------------------------------------------------------------------ 2a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * Copyright (C) 1998-2009 PacketVideo 3a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * 4a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * Licensed under the Apache License, Version 2.0 (the "License"); 5a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * you may not use this file except in compliance with the License. 6a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * You may obtain a copy of the License at 7a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * 8a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * http://www.apache.org/licenses/LICENSE-2.0 9a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * 10a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * Unless required by applicable law or agreed to in writing, software 11a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * distributed under the License is distributed on an "AS IS" BASIS, 12a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either 13a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * express or implied. 14a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * See the License for the specific language governing permissions 15a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * and limitations under the License. 16a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * ------------------------------------------------------------------- 17a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber */ 18a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/**************************************************************************************** 19a30d40083856cb4edd225faf8b488fab156e5976Andreas HuberPortions of this file are derived from the following 3GPP standard: 20a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 21a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 3GPP TS 26.173 22a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber ANSI-C code for the Adaptive Multi-Rate - Wideband (AMR-WB) speech codec 23a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Available from http://www.3gpp.org 24a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 25a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber(C) 2007, 3GPP Organizational Partners (ARIB, ATIS, CCSA, ETSI, TTA, TTC) 26a30d40083856cb4edd225faf8b488fab156e5976Andreas HuberPermission to distribute, modify and use this file under the standard license 27a30d40083856cb4edd225faf8b488fab156e5976Andreas Huberterms listed above has been obtained from the copyright holder. 28a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber****************************************************************************************/ 29a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/* 30a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------ 31a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 32a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 33a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 34a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Filename: agc2_amr_wb.cpp 35a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 36a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Date: 05/08/2007 37a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 38a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------ 39a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber REVISION HISTORY 40a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 41a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 42a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Description: 43a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 44a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------ 45a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber INPUT AND OUTPUT DEFINITIONS 46a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 47a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 * sig_in, (i) : postfilter input signal 48a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 * sig_out, (i/o) : postfilter output signal 49a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 l_trm (i) : subframe size 50a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 51a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 52a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------ 53a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber FUNCTION DESCRIPTION 54a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 55a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Performs adaptive gain control 56a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 57a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------ 58a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber REQUIREMENTS 59a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 60a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 61a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------ 62a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber REFERENCES 63a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 64a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------ 65a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber PSEUDO-CODE 66a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 67a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------ 68a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber*/ 69a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 70a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 71a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*---------------------------------------------------------------------------- 72a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; INCLUDES 73a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber----------------------------------------------------------------------------*/ 74a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 75a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#include "pvamrwbdecoder_cnst.h" 76a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#include "pvamrwbdecoder_acelp.h" 77a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#include "pv_amr_wb_type_defs.h" 78a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#include "pvamrwbdecoder_basic_op.h" 79a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#include "pvamrwb_math_op.h" 80a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 81a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*---------------------------------------------------------------------------- 82a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; MACROS 83a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; Define module specific macros here 84a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber----------------------------------------------------------------------------*/ 85a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 86a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 87a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*---------------------------------------------------------------------------- 88a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; DEFINES 89a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; Include all pre-processor statements here. Include conditional 90a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; compile variables also. 91a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber----------------------------------------------------------------------------*/ 92a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 93a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*---------------------------------------------------------------------------- 94a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; LOCAL FUNCTION DEFINITIONS 95a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; Function Prototype declaration 96a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber----------------------------------------------------------------------------*/ 97a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 98a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*---------------------------------------------------------------------------- 99a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; LOCAL STORE/BUFFER/POINTER DEFINITIONS 100a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; Variable declaration - defined here and used outside this module 101a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber----------------------------------------------------------------------------*/ 102a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 103a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*---------------------------------------------------------------------------- 104a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; EXTERNAL FUNCTION REFERENCES 105a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; Declare functions defined elsewhere and referenced in this module 106a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber----------------------------------------------------------------------------*/ 107a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 108a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*---------------------------------------------------------------------------- 109a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; EXTERNAL GLOBAL STORE/BUFFER/POINTER REFERENCES 110a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; Declare variables used in this module but defined elsewhere 111a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber----------------------------------------------------------------------------*/ 112a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 113a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*---------------------------------------------------------------------------- 114a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; FUNCTION CODE 115a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber----------------------------------------------------------------------------*/ 116a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 117a30d40083856cb4edd225faf8b488fab156e5976Andreas Hubervoid agc2_amr_wb( 118a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 * sig_in, /* (i) : postfilter input signal */ 119a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 * sig_out, /* (i/o) : postfilter output signal */ 120a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 l_trm /* (i) : subframe size */ 121a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber) 122a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber{ 123a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 124a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 i, exp; 125a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 gain_in, gain_out, g0; 126a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int32 s; 127a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 128a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 temp; 129a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 130a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /* calculate gain_out with exponent */ 131a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 132a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber temp = sig_out[0] >> 2; 133a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber s = fxp_mul_16by16(temp, temp) << 1; 134a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber for (i = 1; i < l_trm; i++) 135a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 136a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber temp = sig_out[i] >> 2; 137a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber s = mac_16by16_to_int32(s, temp, temp); 138a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 139a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 140a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 141a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber if (s == 0) 142a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 143a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber return; 144a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 145a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber exp = normalize_amr_wb(s) - 1; 146a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber gain_out = amr_wb_round(s << exp); 147a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 148a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /* calculate gain_in with exponent */ 149a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 150a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber temp = sig_in[0] >> 2; 151a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber s = mul_16by16_to_int32(temp, temp); 152a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber for (i = 1; i < l_trm; i++) 153a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 154a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber temp = sig_in[i] >> 2; 155a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber s = mac_16by16_to_int32(s, temp, temp); 156a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 157a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 158a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 159a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber if (s == 0) 160a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 161a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber g0 = 0; 162a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 163a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber else 164a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 165a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber i = normalize_amr_wb(s); 166a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber gain_in = amr_wb_round(s << i); 167a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber exp -= i; 168a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 169a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /* 170a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * g0 = sqrt(gain_in/gain_out) 171a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber */ 172a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 173a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber s = div_16by16(gain_out, gain_in); 174a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber s = shl_int32(s, 7); /* s = gain_out / gain_in */ 175a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber s = shr_int32(s, exp); /* add exponent */ 176a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 177a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber s = one_ov_sqrt(s); 178a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber g0 = amr_wb_round(shl_int32(s, 9)); 179a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 180a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /* sig_out(n) = gain(n) sig_out(n) */ 181a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 182a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber for (i = 0; i < l_trm; i++) 183a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 184a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber sig_out[i] = extract_h(shl_int32(fxp_mul_16by16(sig_out[i], g0), 3)); 185a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 186a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 187a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 188a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber return; 189a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber} 190a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 191