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: dtx_decoder_amr_wb.cpp 354f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 364f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Date: 05/08/2007 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 484f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber------------------------------------------------------------------------------ 494f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber FUNCTION DESCRIPTION 504f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 514f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber DTX functions 524f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 534f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber------------------------------------------------------------------------------ 544f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber REQUIREMENTS 554f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 564f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 574f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber------------------------------------------------------------------------------ 584f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber REFERENCES 594f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 604f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber------------------------------------------------------------------------------ 614f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber PSEUDO-CODE 624f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 634f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber------------------------------------------------------------------------------ 644f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber*/ 654f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 664f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 674f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 684f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; INCLUDES 694f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 704f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 714f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber#include "pv_amr_wb_type_defs.h" 724f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber#include "pvamrwbdecoder_basic_op.h" 734f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber#include "pvamrwb_math_op.h" 744f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber#include "pvamrwbdecoder_cnst.h" 754f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber#include "pvamrwbdecoder_acelp.h" /* prototype of functions */ 764f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber#include "get_amr_wb_bits.h" 774f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber#include "dtx.h" 784f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 794f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 804f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; MACROS 814f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; Define module specific macros here 824f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 834f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 844f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 854f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 864f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; DEFINES 874f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; Include all pre-processor statements here. Include conditional 884f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; compile variables also. 894f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 904f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 914f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 924f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; LOCAL FUNCTION DEFINITIONS 934f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; Function Prototype declaration 944f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 954f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 964f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 974f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; LOCAL STORE/BUFFER/POINTER DEFINITIONS 984f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; Variable declaration - defined here and used outside this module 994f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 1004f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1014f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 1024f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; EXTERNAL FUNCTION REFERENCES 1034f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; Declare functions defined elsewhere and referenced in this module 1044f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 1054f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1064f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 1074f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; EXTERNAL GLOBAL STORE/BUFFER/POINTER REFERENCES 1084f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; Declare variables used in this module but defined elsewhere 1094f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 1104f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1114f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 1124f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; FUNCTION CODE 1134f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 1144f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/* 1154f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * Function : dtx_dec_amr_wb_reset 1164f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber */ 1174f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huberint16 dtx_dec_amr_wb_reset(dtx_decState * st, const int16 isf_init[]) 1184f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber{ 1194f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 i; 1204f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1214f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1224f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (st == (dtx_decState *) NULL) 1234f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 1244f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* dtx_dec_amr_wb_reset invalid parameter */ 1254f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber return (-1); 1264f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 1274f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->since_last_sid = 0; 1284f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->true_sid_period_inv = (1 << 13); /* 0.25 in Q15 */ 1294f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1304f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->log_en = 3500; 1314f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->old_log_en = 3500; 1324f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* low level noise for better performance in DTX handover cases */ 1334f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1344f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->cng_seed = RANDOM_INITSEED; 1354f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1364f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->hist_ptr = 0; 1374f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1384f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Init isf_hist[] and decoder log frame energy */ 1394f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pv_memcpy((void *)st->isf, (void *)isf_init, M*sizeof(*isf_init)); 1404f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1414f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pv_memcpy((void *)st->isf_old, (void *)isf_init, M*sizeof(*isf_init)); 1424f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1434f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = 0; i < DTX_HIST_SIZE; i++) 1444f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 1454f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pv_memcpy((void *)&st->isf_hist[i * M], (void *)isf_init, M*sizeof(*isf_init)); 1464f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->log_en_hist[i] = st->log_en; 1474f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 1484f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1494f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->dtxHangoverCount = DTX_HANG_CONST; 1504f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->decAnaElapsedCount = 32767; 1514f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1524f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->sid_frame = 0; 1534f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->valid_data = 0; 1544f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->dtxHangoverAdded = 0; 1554f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1564f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->dtxGlobalState = SPEECH; 1574f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->data_updated = 0; 1584f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1594f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->dither_seed = RANDOM_INITSEED; 1604f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->CN_dith = 0; 1614f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1624f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber return 0; 1634f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber} 1644f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1654f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1664f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/* 1674f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Table of new SPD synthesis states 1684f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1694f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber | previous SPD_synthesis_state 1704f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Incoming | 1714f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber frame_type | SPEECH | DTX | DTX_MUTE 1724f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber --------------------------------------------------------------- 1734f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber RX_SPEECH_GOOD , | | | 1744f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber RX_SPEECH_PR_DEGRADED | SPEECH | SPEECH | SPEECH 1754f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ---------------------------------------------------------------- 1764f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber RX_SPEECH_BAD, | SPEECH | DTX | DTX_MUTE 1774f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ---------------------------------------------------------------- 1784f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber RX_SID_FIRST, | DTX | DTX/(DTX_MUTE)| DTX_MUTE 1794f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ---------------------------------------------------------------- 1804f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber RX_SID_UPDATE, | DTX | DTX | DTX 1814f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ---------------------------------------------------------------- 1824f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber RX_SID_BAD, | DTX | DTX/(DTX_MUTE)| DTX_MUTE 1834f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ---------------------------------------------------------------- 1844f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber RX_NO_DATA, | SPEECH | DTX/(DTX_MUTE)| DTX_MUTE 1854f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber RX_SPARE |(class2 garb.)| | 1864f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ---------------------------------------------------------------- 1874f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber*/ 1884f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1894f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 1904f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; FUNCTION CODE 1914f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 1924f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1934f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/* 1944f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * Function : dtx_dec_amr_wb 1954f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber */ 1964f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huberint16 dtx_dec_amr_wb( 1974f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber dtx_decState * st, /* i/o : State struct */ 1984f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 * exc2, /* o : CN excitation */ 1994f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 new_state, /* i : New DTX state */ 2004f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 isf[], /* o : CN ISF vector */ 2014f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 ** prms 2024f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber) 2034f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber{ 2044f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 log_en_index; 2054f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 ind[7]; 2064f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 i, j; 2074f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 int_fac; 2084f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 gain; 2094f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2104f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int32 L_isf[M], L_log_en_int, level32, ener32; 2114f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 ptr; 2124f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 tmp_int_length; 2134f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 tmp, exp, exp0, log_en_int_e, log_en_int_m, level; 2144f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2154f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* This function is called if synthesis state is not SPEECH the globally passed inputs to this function 2164f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * are st->sid_frame st->valid_data st->dtxHangoverAdded new_state (SPEECH, DTX, DTX_MUTE) */ 2174f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2184f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if ((st->dtxHangoverAdded != 0) && 2194f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber (st->sid_frame != 0)) 2204f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 2214f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* sid_first after dtx hangover period */ 2224f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* or sid_upd after dtxhangover */ 2234f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2244f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* consider twice the last frame */ 2254f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ptr = st->hist_ptr + 1; 2264f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2274f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (ptr == DTX_HIST_SIZE) 2284f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ptr = 0; 2294f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2304f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pv_memcpy((void *)&st->isf_hist[ptr * M], (void *)&st->isf_hist[st->hist_ptr * M], M*sizeof(*st->isf_hist)); 2314f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2324f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->log_en_hist[ptr] = st->log_en_hist[st->hist_ptr]; 2334f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2344f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* compute mean log energy and isf from decoded signal (SID_FIRST) */ 2354f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->log_en = 0; 2364f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = 0; i < M; i++) 2374f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 2384f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_isf[i] = 0; 2394f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 2404f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2414f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* average energy and isf */ 2424f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = 0; i < DTX_HIST_SIZE; i++) 2434f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 2444f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Division by DTX_HIST_SIZE = 8 has been done in dtx_buffer log_en is in Q10 */ 2454f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->log_en = add_int16(st->log_en, st->log_en_hist[i]); 2464f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2474f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (j = 0; j < M; j++) 2484f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 2494f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_isf[j] = add_int32(L_isf[j], (int32)(st->isf_hist[i * M + j])); 2504f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 2514f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 2524f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2534f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* st->log_en in Q9 */ 2544f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->log_en >>= 1; 2554f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2564f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Add 2 in Q9, in order to have only positive values for Pow2 */ 2574f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* this value is subtracted back after Pow2 function */ 2584f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->log_en += 1024; 2594f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2604f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (st->log_en < 0) 2614f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->log_en = 0; 2624f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2634f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (j = 0; j < M; j++) 2644f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 2654f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->isf[j] = (int16)(L_isf[j] >> 3); /* divide by 8 */ 2664f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 2674f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2684f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 2694f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2704f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (st->sid_frame != 0) 2714f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 2724f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Set old SID parameters, always shift */ 2734f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* even if there is no new valid_data */ 2744f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2754f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pv_memcpy((void *)st->isf_old, (void *)st->isf, M*sizeof(*st->isf)); 2764f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2774f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->old_log_en = st->log_en; 2784f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2794f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (st->valid_data != 0) /* new data available (no CRC) */ 2804f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 2814f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* st->true_sid_period_inv = 1.0f/st->since_last_sid; */ 2824f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Compute interpolation factor, since the division only works * for values of since_last_sid < 2834f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 32 we have to limit the * interpolation to 32 frames */ 2844f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber tmp_int_length = st->since_last_sid; 2854f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2864f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2874f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (tmp_int_length > 32) 2884f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 2894f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber tmp_int_length = 32; 2904f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 2914f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2924f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (tmp_int_length >= 2) 2934f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 2944f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->true_sid_period_inv = div_16by16(1 << 10, shl_int16(tmp_int_length, 10)); 2954f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 2964f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else 2974f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 2984f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->true_sid_period_inv = 1 << 14; /* 0.5 it Q15 */ 2994f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 3004f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3014f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ind[0] = Serial_parm(6, prms); 3024f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ind[1] = Serial_parm(6, prms); 3034f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ind[2] = Serial_parm(6, prms); 3044f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ind[3] = Serial_parm(5, prms); 3054f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ind[4] = Serial_parm(5, prms); 3064f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3074f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Disf_ns(ind, st->isf); 3084f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3094f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber log_en_index = Serial_parm(6, prms); 3104f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3114f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* read background noise stationarity information */ 3124f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->CN_dith = Serial_parm_1bit(prms); 3134f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3144f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* st->log_en = (float)log_en_index / 2.625 - 2.0; */ 3154f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* log2(E) in Q9 (log2(E) lies in between -2:22) */ 3164f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->log_en = shl_int16(log_en_index, 15 - 6); 3174f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3184f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Divide by 2.625 */ 3194f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->log_en = mult_int16(st->log_en, 12483); 3204f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Subtract 2 in Q9 is done later, after Pow2 function */ 3214f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3224f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* no interpolation at startup after coder reset */ 3234f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* or when SID_UPD has been received right after SPEECH */ 3244f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3254f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if ((st->data_updated == 0) || (st->dtxGlobalState == SPEECH)) 3264f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 3274f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pv_memcpy((void *)st->isf_old, (void *)st->isf, M*sizeof(*st->isf)); 3284f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3294f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->old_log_en = st->log_en; 3304f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 3314f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } /* endif valid_data */ 3324f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } /* endif sid_frame */ 3334f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3344f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3354f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if ((st->sid_frame != 0) && (st->valid_data != 0)) 3364f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 3374f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->since_last_sid = 0; 3384f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 3394f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Interpolate SID info */ 3404f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int_fac = shl_int16(st->since_last_sid, 10); /* Q10 */ 3414f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int_fac = mult_int16(int_fac, st->true_sid_period_inv); /* Q10 * Q15 -> Q10 */ 3424f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3434f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Maximize to 1.0 in Q10 */ 3444f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3454f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (int_fac > 1024) 3464f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 3474f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int_fac = 1024; 3484f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 3494f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int_fac = shl_int16(int_fac, 4); /* Q10 -> Q14 */ 3504f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3514f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_log_en_int = mul_16by16_to_int32(int_fac, st->log_en); /* Q14 * Q9 -> Q24 */ 3524f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3534f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = 0; i < M; i++) 3544f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 3554f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber isf[i] = mult_int16(int_fac, st->isf[i]);/* Q14 * Q15 -> Q14 */ 3564f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 3574f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3584f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int_fac = 16384 - int_fac; /* 1-k in Q14 */ 3594f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3604f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* ( Q14 * Q9 -> Q24 ) + Q24 -> Q24 */ 3614f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_log_en_int = mac_16by16_to_int32(L_log_en_int, int_fac, st->old_log_en); 3624f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3634f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = 0; i < M; i++) 3644f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 3654f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Q14 + (Q14 * Q15 -> Q14) -> Q14 */ 3664f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber isf[i] = add_int16(isf[i], mult_int16(int_fac, st->isf_old[i])); 3674f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber isf[i] = shl_int16(isf[i], 1); /* Q14 -> Q15 */ 3684f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 3694f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3704f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* If background noise is non-stationary, insert comfort noise dithering */ 3714f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (st->CN_dith != 0) 3724f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 3734f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber CN_dithering(isf, &L_log_en_int, &st->dither_seed); 3744f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 3754f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* L_log_en_int corresponds to log2(E)+2 in Q24, i.e log2(gain)+1 in Q25 */ 3764f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Q25 -> Q16 */ 3774f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_log_en_int >>= 9; 3784f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3794f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Find integer part */ 3804f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber log_en_int_e = extract_h(L_log_en_int); 3814f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3824f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Find fractional part */ 3834f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber log_en_int_m = (int16)(sub_int32(L_log_en_int, L_deposit_h(log_en_int_e)) >> 1); 3844f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3854f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Subtract 2 from L_log_en_int in Q9, i.e divide the gain by 2 (energy by 4) */ 3864f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Add 16 in order to have the result of pow2 in Q16 */ 3874f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber log_en_int_e += 15; 3884f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3894f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* level = (float)( pow( 2.0f, log_en ) ); */ 3904f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber level32 = power_of_2(log_en_int_e, log_en_int_m); /* Q16 */ 3914f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3924f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber exp0 = normalize_amr_wb(level32); 3934f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber level32 <<= exp0; /* level in Q31 */ 3944f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber exp0 = 15 - exp0; 3954f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber level = (int16)(level32 >> 16); /* level in Q15 */ 3964f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3974f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* generate white noise vector */ 3984f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = 0; i < L_FRAME; i++) 3994f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 4004f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber exc2[i] = noise_gen_amrwb(&(st->cng_seed)) >> 4; 4014f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 4024f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4034f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* gain = level / sqrt(ener) * sqrt(L_FRAME) */ 4044f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4054f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* energy of generated excitation */ 4064f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ener32 = Dot_product12(exc2, exc2, L_FRAME, &exp); 4074f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4084f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber one_ov_sqrt_norm(&ener32, &exp); 4094f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4104f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber gain = extract_h(ener32); 4114f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4124f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber gain = mult_int16(level, gain); /* gain in Q15 */ 4134f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4144f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber exp += exp0; 4154f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4164f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Multiply by sqrt(L_FRAME)=16, i.e. shift left by 4 */ 4174f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber exp += 4; 4184f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4194f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = 0; i < L_FRAME; i++) 4204f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 4214f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber tmp = mult_int16(exc2[i], gain); /* Q0 * Q15 */ 4224f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber exc2[i] = shl_int16(tmp, exp); 4234f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 4244f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4254f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4264f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (new_state == DTX_MUTE) 4274f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 4284f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* mute comfort noise as it has been quite a long time since last SID update was performed */ 4294f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4304f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber tmp_int_length = st->since_last_sid; 4314f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4324f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (tmp_int_length > 32) 4334f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 4344f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber tmp_int_length = 32; 4354f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 4364f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4374f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->true_sid_period_inv = div_16by16(1 << 10, shl_int16(tmp_int_length, 10)); 4384f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4394f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->since_last_sid = 0; 4404f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->old_log_en = st->log_en; 4414f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* subtract 1/8 in Q9 (energy), i.e -3/8 dB */ 4424f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->log_en -= 64; 4434f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 4444f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* reset interpolation length timer if data has been updated. */ 4454f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4464f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if ((st->sid_frame != 0) && 4474f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ((st->valid_data != 0) || 4484f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ((st->valid_data == 0) && (st->dtxHangoverAdded) != 0))) 4494f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 4504f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->since_last_sid = 0; 4514f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->data_updated = 1; 4524f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 4534f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber return 0; 4544f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber} 4554f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4564f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4574f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 4584f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; FUNCTION CODE 4594f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 4604f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4614f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Hubervoid dtx_dec_amr_wb_activity_update( 4624f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber dtx_decState * st, 4634f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 isf[], 4644f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 exc[]) 4654f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber{ 4664f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 i; 4674f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4684f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int32 L_frame_en; 4694f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 log_en_e, log_en_m, log_en; 4704f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4714f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4724f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->hist_ptr++; 4734f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4744f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (st->hist_ptr == DTX_HIST_SIZE) 4754f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 4764f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->hist_ptr = 0; 4774f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 4784f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pv_memcpy((void *)&st->isf_hist[st->hist_ptr * M], (void *)isf, M*sizeof(*isf)); 4794f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4804f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4814f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* compute log energy based on excitation frame energy in Q0 */ 4824f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_frame_en = 0; 4834f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = 0; i < L_FRAME; i++) 4844f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 4854f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_frame_en = mac_16by16_to_int32(L_frame_en, exc[i], exc[i]); 4864f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 4874f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_frame_en >>= 1; 4884f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4894f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* log_en = (float)log10(L_frame_en/(float)L_FRAME)/(float)log10(2.0f); */ 4904f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber amrwb_log_2(L_frame_en, &log_en_e, &log_en_m); 4914f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4924f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* convert exponent and mantissa to int16 Q7. Q7 is used to simplify averaging in dtx_enc */ 4934f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber log_en = shl_int16(log_en_e, 7); /* Q7 */ 4944f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber log_en += log_en_m >> 8; 4954f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4964f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Divide by L_FRAME = 256, i.e subtract 8 in Q7 = 1024 */ 4974f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber log_en -= 1024; 4984f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4994f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* insert into log energy buffer */ 5004f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->log_en_hist[st->hist_ptr] = log_en; 5014f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5024f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber return; 5034f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber} 5044f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5054f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5064f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/* 5074f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Table of new SPD synthesis states 5084f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5094f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber | previous SPD_synthesis_state 5104f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Incoming | 5114f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber frame_type | SPEECH | DTX | DTX_MUTE 5124f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber --------------------------------------------------------------- 5134f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber RX_SPEECH_GOOD , | | | 5144f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber RX_SPEECH_PR_DEGRADED | SPEECH | SPEECH | SPEECH 5154f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ---------------------------------------------------------------- 5164f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber RX_SPEECH_BAD, | SPEECH | DTX | DTX_MUTE 5174f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ---------------------------------------------------------------- 5184f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber RX_SID_FIRST, | DTX | DTX/(DTX_MUTE)| DTX_MUTE 5194f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ---------------------------------------------------------------- 5204f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber RX_SID_UPDATE, | DTX | DTX | DTX 5214f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ---------------------------------------------------------------- 5224f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber RX_SID_BAD, | DTX | DTX/(DTX_MUTE)| DTX_MUTE 5234f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ---------------------------------------------------------------- 5244f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber RX_NO_DATA, | SPEECH | DTX/(DTX_MUTE)| DTX_MUTE 5254f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber RX_SPARE |(class2 garb.)| | 5264f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ---------------------------------------------------------------- 5274f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber*/ 5284f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5294f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5304f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 5314f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; FUNCTION CODE 5324f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 5334f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5344f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huberint16 rx_amr_wb_dtx_handler( 5354f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber dtx_decState * st, /* i/o : State struct */ 5364f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 frame_type /* i : Frame type */ 5374f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber) 5384f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber{ 5394f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 newState; 5404f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 encState; 5414f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5424f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* DTX if SID frame or previously in DTX{_MUTE} and (NO_RX OR BAD_SPEECH) */ 5434f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5444f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5454f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5464f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if ((frame_type == RX_SID_FIRST) || 5474f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber (frame_type == RX_SID_UPDATE) || 5484f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber (frame_type == RX_SID_BAD) || 5494f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber (((st->dtxGlobalState == DTX) || 5504f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber (st->dtxGlobalState == DTX_MUTE)) && 5514f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ((frame_type == RX_NO_DATA) || 5524f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber (frame_type == RX_SPEECH_BAD) || 5534f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber (frame_type == RX_SPEECH_LOST)))) 5544f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 5554f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber newState = DTX; 5564f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5574f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* stay in mute for these input types */ 5584f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5594f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if ((st->dtxGlobalState == DTX_MUTE) && 5604f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ((frame_type == RX_SID_BAD) || 5614f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber (frame_type == RX_SID_FIRST) || 5624f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber (frame_type == RX_SPEECH_LOST) || 5634f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber (frame_type == RX_NO_DATA))) 5644f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 5654f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber newState = DTX_MUTE; 5664f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 5674f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* evaluate if noise parameters are too old */ 5684f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* since_last_sid is reset when CN parameters have been updated */ 5694f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->since_last_sid = add_int16(st->since_last_sid, 1); 5704f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5714f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* no update of sid parameters in DTX for a long while */ 5724f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5734f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (st->since_last_sid > DTX_MAX_EMPTY_THRESH) 5744f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 5754f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber newState = DTX_MUTE; 5764f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 5774f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 5784f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else 5794f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 5804f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber newState = SPEECH; 5814f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->since_last_sid = 0; 5824f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 5834f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5844f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* reset the decAnaElapsed Counter when receiving CNI data the first time, to robustify counter missmatch 5854f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * after handover this might delay the bwd CNI analysis in the new decoder slightly. */ 5864f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5874f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if ((st->data_updated == 0) && 5884f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber (frame_type == RX_SID_UPDATE)) 5894f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 5904f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->decAnaElapsedCount = 0; 5914f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 5924f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* update the SPE-SPD DTX hangover synchronization */ 5934f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* to know when SPE has added dtx hangover */ 5944f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->decAnaElapsedCount = add_int16(st->decAnaElapsedCount, 1); 5954f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->dtxHangoverAdded = 0; 5964f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5974f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5984f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if ((frame_type == RX_SID_FIRST) || 5994f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber (frame_type == RX_SID_UPDATE) || 6004f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber (frame_type == RX_SID_BAD) || 6014f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber (frame_type == RX_NO_DATA)) 6024f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 6034f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber encState = DTX; 6044f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 6054f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else 6064f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 6074f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber encState = SPEECH; 6084f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 6094f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 6104f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 6114f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (encState == SPEECH) 6124f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 6134f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->dtxHangoverCount = DTX_HANG_CONST; 6144f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 6154f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else 6164f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 6174f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 6184f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (st->decAnaElapsedCount > DTX_ELAPSED_FRAMES_THRESH) 6194f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 6204f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->dtxHangoverAdded = 1; 6214f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->decAnaElapsedCount = 0; 6224f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->dtxHangoverCount = 0; 6234f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 6244f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else if (st->dtxHangoverCount == 0) 6254f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 6264f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->decAnaElapsedCount = 0; 6274f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 6284f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else 6294f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 6304f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->dtxHangoverCount--; 6314f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 6324f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 6334f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 6344f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (newState != SPEECH) 6354f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 6364f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* DTX or DTX_MUTE CN data is not in a first SID, first SIDs are marked as SID_BAD but will do 6374f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * backwards analysis if a hangover period has been added according to the state machine above */ 6384f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 6394f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->sid_frame = 0; 6404f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->valid_data = 0; 6414f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 6424f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 6434f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (frame_type == RX_SID_FIRST) 6444f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 6454f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->sid_frame = 1; 6464f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 6474f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else if (frame_type == RX_SID_UPDATE) 6484f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 6494f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->sid_frame = 1; 6504f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->valid_data = 1; 6514f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 6524f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else if (frame_type == RX_SID_BAD) 6534f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 6544f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->sid_frame = 1; 6554f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->dtxHangoverAdded = 0; /* use old data */ 6564f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 6574f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 6584f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber return newState; 6594f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* newState is used by both SPEECH AND DTX synthesis routines */ 6604f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber} 6614f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 6624f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 6634f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 6644f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; FUNCTION CODE 6654f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 6664f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 6674f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Hubervoid aver_isf_history( 6684f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 isf_old[], 6694f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 indices[], 6704f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int32 isf_aver[] 6714f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber) 6724f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber{ 6734f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 i, j, k; 6744f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 isf_tmp[2 * M]; 6754f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int32 L_tmp; 6764f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 6774f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Memorize in isf_tmp[][] the ISF vectors to be replaced by */ 6784f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* the median ISF vector prior to the averaging */ 6794f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (k = 0; k < 2; k++) 6804f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 6814f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 6824f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (indices[k] + 1 != 0) 6834f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 6844f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = 0; i < M; i++) 6854f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 6864f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber isf_tmp[k * M + i] = isf_old[indices[k] * M + i]; 6874f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber isf_old[indices[k] * M + i] = isf_old[indices[2] * M + i]; 6884f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 6894f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 6904f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 6914f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 6924f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Perform the ISF averaging */ 6934f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (j = 0; j < M; j++) 6944f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 6954f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = 0; 6964f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 6974f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = 0; i < DTX_HIST_SIZE; i++) 6984f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 6994f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = add_int32(L_tmp, (int32)(isf_old[i * M + j])); 7004f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 7014f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber isf_aver[j] = L_tmp; 7024f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 7034f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 7044f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Retrieve from isf_tmp[][] the ISF vectors saved prior to averaging */ 7054f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (k = 0; k < 2; k++) 7064f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 7074f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 7084f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (indices[k] + 1 != 0) 7094f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 7104f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = 0; i < M; i++) 7114f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 7124f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber isf_old[indices[k] * M + i] = isf_tmp[k * M + i]; 7134f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 7144f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 7154f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 7164f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 7174f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber return; 7184f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber} 7194f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 7204f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 7214f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 7224f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; FUNCTION CODE 7234f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 7244f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 7254f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Hubervoid find_frame_indices( 7264f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 isf_old_tx[], 7274f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 indices[], 7284f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber dtx_encState * st 7294f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber) 7304f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber{ 7314f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int32 L_tmp, summin, summax, summax2nd; 7324f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 i, j, tmp; 7334f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 ptr; 7344f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 7354f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Remove the effect of the oldest frame from the column */ 7364f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* sum sumD[0..DTX_HIST_SIZE-1]. sumD[DTX_HIST_SIZE] is */ 7374f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* not updated since it will be removed later. */ 7384f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 7394f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber tmp = DTX_HIST_SIZE_MIN_ONE; 7404f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber j = -1; 7414f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = 0; i < DTX_HIST_SIZE_MIN_ONE; i++) 7424f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 7434f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber j += tmp; 7444f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->sumD[i] = sub_int32(st->sumD[i], st->D[j]); 7454f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber tmp--; 7464f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 7474f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 7484f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Shift the column sum sumD. The element sumD[DTX_HIST_SIZE-1] */ 7494f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* corresponding to the oldest frame is removed. The sum of */ 7504f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* the distances between the latest isf and other isfs, */ 7514f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* i.e. the element sumD[0], will be computed during this call. */ 7524f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Hence this element is initialized to zero. */ 7534f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 7544f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = DTX_HIST_SIZE_MIN_ONE; i > 0; i--) 7554f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 7564f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->sumD[i] = st->sumD[i - 1]; 7574f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 7584f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->sumD[0] = 0; 7594f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 7604f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Remove the oldest frame from the distance matrix. */ 7614f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Note that the distance matrix is replaced by a one- */ 7624f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* dimensional array to save static memory. */ 7634f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 7644f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber tmp = 0; 7654f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = 27; i >= 12; i -= tmp) 7664f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 7674f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber tmp++; 7684f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (j = tmp; j > 0; j--) 7694f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 7704f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->D[i - j + 1] = st->D[i - j - tmp]; 7714f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 7724f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 7734f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 7744f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Compute the first column of the distance matrix D */ 7754f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* (squared Euclidean distances from isf1[] to isf_old_tx[][]). */ 7764f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 7774f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ptr = st->hist_ptr; 7784f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = 1; i < DTX_HIST_SIZE; i++) 7794f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 7804f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Compute the distance between the latest isf and the other isfs. */ 7814f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ptr--; 7824f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 7834f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (ptr < 0) 7844f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 7854f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ptr = DTX_HIST_SIZE_MIN_ONE; 7864f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 7874f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = 0; 7884f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (j = 0; j < M; j++) 7894f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 7904f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber tmp = sub_int16(isf_old_tx[st->hist_ptr * M + j], isf_old_tx[ptr * M + j]); 7914f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = mac_16by16_to_int32(L_tmp, tmp, tmp); 7924f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 7934f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->D[i - 1] = L_tmp; 7944f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 7954f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Update also the column sums. */ 7964f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->sumD[0] = add_int32(st->sumD[0], st->D[i - 1]); 7974f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->sumD[i] = add_int32(st->sumD[i], st->D[i - 1]); 7984f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 7994f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 8004f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Find the minimum and maximum distances */ 8014f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber summax = st->sumD[0]; 8024f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber summin = st->sumD[0]; 8034f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber indices[0] = 0; 8044f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber indices[2] = 0; 8054f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = 1; i < DTX_HIST_SIZE; i++) 8064f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 8074f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 8084f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (st->sumD[i] > summax) 8094f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 8104f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber indices[0] = i; 8114f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber summax = st->sumD[i]; 8124f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 8134f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 8144f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (st->sumD[i] < summin) 8154f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 8164f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber indices[2] = i; 8174f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber summin = st->sumD[i]; 8184f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 8194f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 8204f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 8214f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Find the second largest distance */ 8224f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber summax2nd = -2147483647L; 8234f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber indices[1] = -1; 8244f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = 0; i < DTX_HIST_SIZE; i++) 8254f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 8264f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 8274f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if ((st->sumD[i] > summax2nd) && (i != indices[0])) 8284f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 8294f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber indices[1] = i; 8304f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber summax2nd = st->sumD[i]; 8314f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 8324f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 8334f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 8344f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = 0; i < 3; i++) 8354f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 8364f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber indices[i] = sub_int16(st->hist_ptr, indices[i]); 8374f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 8384f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (indices[i] < 0) 8394f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 8404f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber indices[i] = add_int16(indices[i], DTX_HIST_SIZE); 8414f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 8424f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 8434f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 8444f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* If maximum distance/MED_THRESH is smaller than minimum distance */ 8454f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* then the median ISF vector replacement is not performed */ 8464f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber tmp = normalize_amr_wb(summax); 8474f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber summax <<= tmp; 8484f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber summin <<= tmp; 8494f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = mul_16by16_to_int32(amr_wb_round(summax), INV_MED_THRESH); 8504f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 8514f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (L_tmp <= summin) 8524f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 8534f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber indices[0] = -1; 8544f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 8554f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* If second largest distance/MED_THRESH is smaller than */ 8564f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* minimum distance then the median ISF vector replacement is */ 8574f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* not performed */ 8584f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber summax2nd = shl_int32(summax2nd, tmp); 8594f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = mul_16by16_to_int32(amr_wb_round(summax2nd), INV_MED_THRESH); 8604f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 8614f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (L_tmp <= summin) 8624f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 8634f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber indices[1] = -1; 8644f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 8654f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber return; 8664f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber} 8674f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 8684f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 8694f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 8704f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; FUNCTION CODE 8714f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 8724f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 8734f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huberint16 dithering_control(dtx_encState * st) 8744f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber{ 8754f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 i, tmp, mean, CN_dith, gain_diff; 8764f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int32 ISF_diff; 8774f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 8784f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* determine how stationary the spectrum of background noise is */ 8794f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ISF_diff = 0; 8804f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = 0; i < 8; i++) 8814f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 8824f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ISF_diff = add_int32(ISF_diff, st->sumD[i]); 8834f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 8844f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if ((ISF_diff >> 26) > 0) 8854f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 8864f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber CN_dith = 1; 8874f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 8884f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else 8894f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 8904f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber CN_dith = 0; 8914f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 8924f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 8934f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* determine how stationary the energy of background noise is */ 8944f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber mean = 0; 8954f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = 0; i < DTX_HIST_SIZE; i++) 8964f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 8974f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber mean = add_int16(mean, st->log_en_hist[i]); 8984f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 8994f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber mean >>= 3; 9004f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber gain_diff = 0; 9014f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = 0; i < DTX_HIST_SIZE; i++) 9024f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 9034f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber tmp = sub_int16(st->log_en_hist[i], mean); 9044f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber tmp = tmp - (tmp < 0); 9054f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 9064f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber gain_diff += tmp ^(tmp >> 15); /* tmp ^sign(tmp) */; 9074f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 9084f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (gain_diff > GAIN_THR) 9094f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 9104f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber CN_dith = 1; 9114f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 9124f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber return CN_dith; 9134f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber} 9144f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 9154f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 9164f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 9174f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; FUNCTION CODE 9184f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 9194f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 9204f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Hubervoid CN_dithering( 9214f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 isf[M], 9224f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int32 * L_log_en_int, 9234f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 * dither_seed 9244f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber) 9254f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber{ 9264f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 temp, temp1, i, dither_fac, rand_dith; 9274f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 rand_dith2; 9284f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 9294f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Insert comfort noise dithering for energy parameter */ 9304f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber rand_dith = noise_gen_amrwb(dither_seed) >> 1; 9314f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber rand_dith2 = noise_gen_amrwb(dither_seed) >> 1; 9324f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber rand_dith += rand_dith2; 9334f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber *L_log_en_int = add_int32(*L_log_en_int, mul_16by16_to_int32(rand_dith, GAIN_FACTOR)); 9344f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 9354f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (*L_log_en_int < 0) 9364f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 9374f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber *L_log_en_int = 0; 9384f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 9394f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Insert comfort noise dithering for spectral parameters (ISF-vector) */ 9404f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber dither_fac = ISF_FACTOR_LOW; 9414f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 9424f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber rand_dith = noise_gen_amrwb(dither_seed) >> 1; 9434f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber rand_dith2 = noise_gen_amrwb(dither_seed) >> 1; 9444f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber rand_dith += rand_dith2; 9454f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber temp = add_int16(isf[0], mult_int16_r(rand_dith, dither_fac)); 9464f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 9474f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Make sure that isf[0] will not get negative values */ 9484f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (temp < ISF_GAP) 9494f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 9504f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber isf[0] = ISF_GAP; 9514f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 9524f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else 9534f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 9544f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber isf[0] = temp; 9554f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 9564f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 9574f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = 1; i < M - 1; i++) 9584f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 9594f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber dither_fac = add_int16(dither_fac, ISF_FACTOR_STEP); 9604f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 9614f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber rand_dith = noise_gen_amrwb(dither_seed) >> 1; 9624f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber rand_dith2 = noise_gen_amrwb(dither_seed) >> 1; 9634f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber rand_dith += rand_dith2; 9644f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber temp = add_int16(isf[i], mult_int16_r(rand_dith, dither_fac)); 9654f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber temp1 = sub_int16(temp, isf[i - 1]); 9664f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 9674f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Make sure that isf spacing remains at least ISF_DITH_GAP Hz */ 9684f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (temp1 < ISF_DITH_GAP) 9694f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 9704f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber isf[i] = isf[i - 1] + ISF_DITH_GAP; 9714f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 9724f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else 9734f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 9744f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber isf[i] = temp; 9754f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 9764f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 9774f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 9784f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Make sure that isf[M-2] will not get values above 16384 */ 9794f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (isf[M - 2] > 16384) 9804f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 9814f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber isf[M - 2] = 16384; 9824f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 9834f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber return; 9844f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber} 985