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: lagconceal.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 gain_hist[], (i) : Gain history 48a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 lag_hist[], (i) : Subframe size 49a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 * T0, (i/o): current lag 50a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 * old_T0, (i/o): previous lag 51a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 * seed, 52a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 unusable_frame 53a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 54a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------ 55a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber FUNCTION DESCRIPTION 56a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 57a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Concealment of LTP lags during bad frames 58a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 59a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------ 60a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber REQUIREMENTS 61a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 62a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 63a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------ 64a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber REFERENCES 65a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 66a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------ 67a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber PSEUDO-CODE 68a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 69a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------ 70a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber*/ 71a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 72a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 73a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*---------------------------------------------------------------------------- 74a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; INCLUDES 75a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber----------------------------------------------------------------------------*/ 76a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 77a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#include "pv_amr_wb_type_defs.h" 78a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#include "pvamrwbdecoder_basic_op.h" 79a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#include "pvamrwbdecoder_cnst.h" 80a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#include "pvamrwbdecoder_acelp.h" 81a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 82a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*---------------------------------------------------------------------------- 83a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; MACROS 84a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; Define module specific macros here 85a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber----------------------------------------------------------------------------*/ 86a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 87a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 88a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*---------------------------------------------------------------------------- 89a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; DEFINES 90a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; Include all pre-processor statements here. Include conditional 91a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; compile variables also. 92a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber----------------------------------------------------------------------------*/ 93a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#define L_LTPHIST 5 94a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#define ONE_PER_3 10923 95a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#define ONE_PER_LTPHIST 6554 96a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 97a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*---------------------------------------------------------------------------- 98a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; LOCAL FUNCTION DEFINITIONS 99a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; Function Prototype declaration 100a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber----------------------------------------------------------------------------*/ 101a30d40083856cb4edd225faf8b488fab156e5976Andreas Hubervoid insertion_sort(int16 array[], int16 n); 102a30d40083856cb4edd225faf8b488fab156e5976Andreas Hubervoid insert(int16 array[], int16 num, int16 x); 103a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 104a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*---------------------------------------------------------------------------- 105a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; LOCAL STORE/BUFFER/POINTER DEFINITIONS 106a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; Variable declaration - defined here and used outside this module 107a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber----------------------------------------------------------------------------*/ 108a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 109a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*---------------------------------------------------------------------------- 110a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; EXTERNAL FUNCTION REFERENCES 111a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; Declare functions defined elsewhere and referenced in this module 112a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber----------------------------------------------------------------------------*/ 113a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 114a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*---------------------------------------------------------------------------- 115a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; EXTERNAL GLOBAL STORE/BUFFER/POINTER REFERENCES 116a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; Declare variables used in this module but defined elsewhere 117a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber----------------------------------------------------------------------------*/ 118a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 119a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*---------------------------------------------------------------------------- 120a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; FUNCTION CODE 121a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber----------------------------------------------------------------------------*/ 122a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 123a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 124a30d40083856cb4edd225faf8b488fab156e5976Andreas Hubervoid Init_Lagconc(int16 lag_hist[]) 125a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber{ 126a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 i; 127a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 128a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber for (i = 0; i < L_LTPHIST; i++) 129a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 130a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lag_hist[i] = 64; 131a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 132a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber} 133a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 134a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*---------------------------------------------------------------------------- 135a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; FUNCTION CODE 136a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber----------------------------------------------------------------------------*/ 137a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 138a30d40083856cb4edd225faf8b488fab156e5976Andreas Hubervoid lagconceal( 139a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 gain_hist[], /* (i) : Gain history */ 140a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 lag_hist[], /* (i) : Subframe size */ 141a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 * T0, 142a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 * old_T0, 143a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 * seed, 144a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 unusable_frame 145a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber) 146a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber{ 147a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 maxLag, minLag, lastLag, lagDif, meanLag = 0; 148a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 lag_hist2[L_LTPHIST] = {0}; 149a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 i, tmp, tmp2; 150a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 minGain, lastGain, secLastGain; 151a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 D, D2; 152a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 153a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /* Is lag index such that it can be aplied directly or does it has to be subtituted */ 154a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 155a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lastGain = gain_hist[4]; 156a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber secLastGain = gain_hist[3]; 157a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 158a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lastLag = lag_hist[0]; 159a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 160a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /******* SMALLEST history lag *******/ 161a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber minLag = lag_hist[0]; 162a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /******* BIGGEST history lag *******/ 163a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber maxLag = lag_hist[0]; 164a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber for (i = 1; i < L_LTPHIST; i++) 165a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 166a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber if (lag_hist[i] < minLag) 167a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 168a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber minLag = lag_hist[i]; 169a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 170a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber if (lag_hist[i] > maxLag) 171a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 172a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber maxLag = lag_hist[i]; 173a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 174a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 175a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /***********SMALLEST history gain***********/ 176a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber minGain = gain_hist[0]; 177a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber for (i = 1; i < L_LTPHIST; i++) 178a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 179a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 180a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber if (gain_hist[i] < minGain) 181a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 182a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber minGain = gain_hist[i]; 183a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 184a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 185a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /***Difference between MAX and MIN lag**/ 186a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lagDif = sub_int16(maxLag, minLag); 187a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 188a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 189a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber if (unusable_frame != 0) 190a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 191a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /* LTP-lag for RX_SPEECH_LOST */ 192a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /**********Recognition of the LTP-history*********/ 193a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 194a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber if ((minGain > 8192) && (lagDif < 10)) 195a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 196a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *T0 = *old_T0; 197a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 198a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber else if (lastGain > 8192 && secLastGain > 8192) 199a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 200a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *T0 = lag_hist[0]; 201a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 202a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber else 203a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 204a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /********SORT************/ 205a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /* The sorting of the lag history */ 206a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber for (i = 0; i < L_LTPHIST; i++) 207a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 208a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lag_hist2[i] = lag_hist[i]; 209a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 210a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber insertion_sort(lag_hist2, 5); 211a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 212a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /* Lag is weighted towards bigger lags */ 213a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /* and random variation is added */ 214a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lagDif = sub_int16(lag_hist2[4], lag_hist2[2]); 215a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 216a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 217a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber if (lagDif > 40) 218a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 219a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lagDif = 40; 220a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 221a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 222a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber D = noise_gen_amrwb(seed); /* D={-1, ...,1} */ 223a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /* D2={-lagDif/2..lagDif/2} */ 224a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber tmp = lagDif >> 1; 225a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber D2 = mult_int16(tmp, D); 226a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber tmp = add_int16(add_int16(lag_hist2[2], lag_hist2[3]), lag_hist2[4]); 227a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *T0 = add_int16(mult_int16(tmp, ONE_PER_3), D2); 228a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 229a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /* New lag is not allowed to be bigger or smaller than last lag values */ 230a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 231a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber if (*T0 > maxLag) 232a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 233a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *T0 = maxLag; 234a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 235a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 236a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber if (*T0 < minLag) 237a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 238a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *T0 = minLag; 239a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 240a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 241a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber else 242a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 243a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /* LTP-lag for RX_BAD_FRAME */ 244a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 245a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /***********MEAN lag**************/ 246a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber meanLag = 0; 247a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber for (i = 0; i < L_LTPHIST; i++) 248a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 249a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber meanLag = add_int16(meanLag, lag_hist[i]); 250a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 251a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber meanLag = mult_int16(meanLag, ONE_PER_LTPHIST); 252a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 253a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber tmp = *T0 - maxLag; 254a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber tmp2 = *T0 - lastLag; 255a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 256a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber if ((lagDif < 10) && (*T0 > (minLag - 5)) && (tmp < 5)) 257a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 258a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *T0 = *T0; 259a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 260a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber else if ((lastGain > 8192) && (secLastGain > 8192) && ((tmp2 + 10) > 0 && tmp2 < 10)) 261a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 262a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *T0 = *T0; 263a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 264a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber else if ((minGain < 6554) && (lastGain == minGain) && (*T0 > minLag && *T0 < maxLag)) 265a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 266a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *T0 = *T0; 267a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 268a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber else if ((lagDif < 70) && (*T0 > minLag) && (*T0 < maxLag)) 269a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 270a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *T0 = *T0; 271a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 272a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber else if ((*T0 > meanLag) && (*T0 < maxLag)) 273a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 274a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *T0 = *T0; 275a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 276a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber else 277a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 278a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 279a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 280a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber if ((minGain > 8192) & (lagDif < 10)) 281a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 282a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *T0 = lag_hist[0]; 283a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 284a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber else if ((lastGain > 8192) && (secLastGain > 8192)) 285a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 286a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *T0 = lag_hist[0]; 287a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 288a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber else 289a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 290a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /********SORT************/ 291a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /* The sorting of the lag history */ 292a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber for (i = 0; i < L_LTPHIST; i++) 293a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 294a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lag_hist2[i] = lag_hist[i]; 295a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 296a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber insertion_sort(lag_hist2, 5); 297a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 298a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /* Lag is weighted towards bigger lags */ 299a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /* and random variation is added */ 300a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lagDif = sub_int16(lag_hist2[4], lag_hist2[2]); 301a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 302a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber if (lagDif > 40) 303a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 304a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lagDif = 40; 305a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 306a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 307a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber D = noise_gen_amrwb(seed); /* D={-1,.., 1} */ 308a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /* D2={-lagDif/2..lagDif/2} */ 309a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber tmp = lagDif >> 1; 310a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber D2 = mult_int16(tmp, D); 311a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber tmp = add_int16(add_int16(lag_hist2[2], lag_hist2[3]), lag_hist2[4]); 312a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *T0 = add_int16(mult_int16(tmp, ONE_PER_3), D2); 313a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 314a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /* New lag is not allowed to be bigger or smaller than last lag values */ 315a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 316a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber if (*T0 > maxLag) 317a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 318a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *T0 = maxLag; 319a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 320a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 321a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber if (*T0 < minLag) 322a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 323a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *T0 = minLag; 324a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 325a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 326a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 327a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber} 328a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 329a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*---------------------------------------------------------------------------- 330a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; FUNCTION CODE 331a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber----------------------------------------------------------------------------*/ 332a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 333a30d40083856cb4edd225faf8b488fab156e5976Andreas Hubervoid insertion_sort(int16 array[], int16 n) 334a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber{ 335a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 i; 336a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 337a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber for (i = 0; i < n; i++) 338a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 339a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber insert(array, i, array[i]); 340a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 341a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber} 342a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 343a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*---------------------------------------------------------------------------- 344a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; FUNCTION CODE 345a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber----------------------------------------------------------------------------*/ 346a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 347a30d40083856cb4edd225faf8b488fab156e5976Andreas Hubervoid insert(int16 array[], int16 n, int16 x) 348a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber{ 349a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 i; 350a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 351a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber for (i = (n - 1); i >= 0; i--) 352a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 353a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 354a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber if (x < array[i]) 355a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 356a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber array[i + 1] = array[i]; 357a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 358a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber else 359a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 360a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber break; 361a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 362a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 363a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber array[i + 1] = x; 364a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber} 365