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: pvamrwbdecoder.cpp 354f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 364f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Date: 05/08/2004 374f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 384f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber------------------------------------------------------------------------------ 394f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber REVISION HISTORY 404f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 414f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 424f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Description: 434f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 444f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber------------------------------------------------------------------------------ 454f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber INPUT AND OUTPUT DEFINITIONS 464f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 474f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 mode, input : used mode 484f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 prms[], input : parameter vector 494f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 synth16k[], output: synthesis speech 504f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 * frame_length, output: lenght of the frame 514f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber void *spd_state, i/o : State structure 524f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 frame_type, input : received frame type 534f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 ScratchMem[] 544f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 554f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber------------------------------------------------------------------------------ 564f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber FUNCTION DESCRIPTION 574f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 584f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Performs the main decoder routine AMR WB ACELP coding algorithm with 20 ms 594f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber speech frames for wideband speech signals. 604f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 614f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 624f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber------------------------------------------------------------------------------ 634f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber REQUIREMENTS 644f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 654f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 664f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber------------------------------------------------------------------------------ 674f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber REFERENCES 684f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 694f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber------------------------------------------------------------------------------ 704f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber PSEUDO-CODE 714f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 724f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber------------------------------------------------------------------------------ 734f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber*/ 744f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 754f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 764f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 774f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; INCLUDES 784f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 794f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 804f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber#include "pv_amr_wb_type_defs.h" 814f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber#include "pvamrwbdecoder_mem_funcs.h" 824f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber#include "pvamrwbdecoder_basic_op.h" 834f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber#include "pvamrwbdecoder_cnst.h" 844f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber#include "pvamrwbdecoder_acelp.h" 854f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber#include "e_pv_amrwbdec.h" 864f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber#include "get_amr_wb_bits.h" 874f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber#include "pvamrwb_math_op.h" 884f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber#include "pvamrwbdecoder_api.h" 894f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber#include "pvamrwbdecoder.h" 904f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber#include "synthesis_amr_wb.h" 914f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 924f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 934f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 944f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; MACROS 954f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; Define module specific macros here 964f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 974f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 984f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 994f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 1004f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; DEFINES 1014f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; Include all pre-processor statements here. Include conditional 1024f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; compile variables also. 1034f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 1044f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1054f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 1064f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; LOCAL STORE/BUFFER/POINTER DEFINITIONS 1074f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; Variable declaration - defined here and used outside this module 1084f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 1094f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1104f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/* LPC interpolation coef {0.45, 0.8, 0.96, 1.0}; in Q15 */ 1114f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huberstatic const int16 interpol_frac[NB_SUBFR] = {14746, 26214, 31457, 32767}; 1124f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1134f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1144f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/* isp tables for initialization */ 1154f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1164f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huberstatic const int16 isp_init[M] = 1174f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber{ 1184f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 32138, 30274, 27246, 23170, 18205, 12540, 6393, 0, 1194f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber -6393, -12540, -18205, -23170, -27246, -30274, -32138, 1475 1204f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber}; 1214f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1224f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huberstatic const int16 isf_init[M] = 1234f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber{ 1244f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1024, 2048, 3072, 4096, 5120, 6144, 7168, 8192, 1254f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 9216, 10240, 11264, 12288, 13312, 14336, 15360, 3840 1264f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber}; 1274f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1284f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 1294f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; EXTERNAL FUNCTION REFERENCES 1304f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; Declare functions defined elsewhere and referenced in this module 1314f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 1324f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1334f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 1344f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; EXTERNAL GLOBAL STORE/BUFFER/POINTER REFERENCES 1354f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; Declare variables used in this module but defined elsewhere 1364f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 1374f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1384f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 1394f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; FUNCTION CODE 1404f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 1414f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1424f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 1434f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber FUNCTION DESCRIPTION pvDecoder_AmrWb_Init 1444f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1454f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Initialization of variables for the decoder section. 1464f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1474f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 1484f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1494f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1504f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1514f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1524f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Hubervoid pvDecoder_AmrWb_Init(void **spd_state, void *pt_st, int16 **ScratchMem) 1534f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber{ 1544f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Decoder states */ 1554f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Decoder_State *st = &(((PV_AmrWbDec *)pt_st)->state); 1564f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1574f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber *ScratchMem = ((PV_AmrWbDec *)pt_st)->ScratchMem; 1584f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* 1594f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * Init dtx decoding 1604f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber */ 1614f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber dtx_dec_amr_wb_reset(&(st->dtx_decSt), isf_init); 1624f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1634f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pvDecoder_AmrWb_Reset((void *) st, 1); 1644f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1654f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber *spd_state = (void *) st; 1664f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1674f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber return; 1684f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber} 1694f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1704f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 1714f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; FUNCTION CODE 1724f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 1734f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1744f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Hubervoid pvDecoder_AmrWb_Reset(void *st, int16 reset_all) 1754f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber{ 1764f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 i; 1774f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1784f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Decoder_State *dec_state; 1794f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1804f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber dec_state = (Decoder_State *) st; 1814f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1824f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pv_memset((void *)dec_state->old_exc, 1834f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 0, 1844f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber (PIT_MAX + L_INTERPOL)*sizeof(*dec_state->old_exc)); 1854f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1864f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pv_memset((void *)dec_state->past_isfq, 1874f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 0, 1884f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber M*sizeof(*dec_state->past_isfq)); 1894f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1904f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1914f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber dec_state->old_T0_frac = 0; /* old pitch value = 64.0 */ 1924f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber dec_state->old_T0 = 64; 1934f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber dec_state->first_frame = 1; 1944f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber dec_state->L_gc_thres = 0; 1954f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber dec_state->tilt_code = 0; 1964f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1974f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pv_memset((void *)dec_state->disp_mem, 1984f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 0, 1994f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 8*sizeof(*dec_state->disp_mem)); 2004f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2014f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2024f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* scaling memories for excitation */ 2034f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber dec_state->Q_old = Q_MAX; 2044f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber dec_state->Qsubfr[3] = Q_MAX; 2054f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber dec_state->Qsubfr[2] = Q_MAX; 2064f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber dec_state->Qsubfr[1] = Q_MAX; 2074f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber dec_state->Qsubfr[0] = Q_MAX; 2084f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2094f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (reset_all != 0) 2104f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 2114f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* routines initialization */ 2124f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2134f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber dec_gain2_amr_wb_init(dec_state->dec_gain); 2144f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber oversamp_12k8_to_16k_init(dec_state->mem_oversamp); 2154f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber band_pass_6k_7k_init(dec_state->mem_hf); 2164f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber low_pass_filt_7k_init(dec_state->mem_hf3); 2174f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber highpass_50Hz_at_12k8_init(dec_state->mem_sig_out); 2184f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber highpass_400Hz_at_12k8_init(dec_state->mem_hp400); 2194f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Init_Lagconc(dec_state->lag_hist); 2204f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2214f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* isp initialization */ 2224f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2234f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pv_memcpy((void *)dec_state->ispold, (void *)isp_init, M*sizeof(*isp_init)); 2244f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2254f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pv_memcpy((void *)dec_state->isfold, (void *)isf_init, M*sizeof(*isf_init)); 2264f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = 0; i < L_MEANBUF; i++) 2274f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 2284f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pv_memcpy((void *)&dec_state->isf_buf[i * M], 2294f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber (void *)isf_init, 2304f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber M*sizeof(*isf_init)); 2314f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 2324f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* variable initialization */ 2334f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2344f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber dec_state->mem_deemph = 0; 2354f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2364f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber dec_state->seed = 21845; /* init random with 21845 */ 2374f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber dec_state->seed2 = 21845; 2384f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber dec_state->seed3 = 21845; 2394f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2404f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber dec_state->state = 0; 2414f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber dec_state->prev_bfi = 0; 2424f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2434f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Static vectors to zero */ 2444f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2454f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pv_memset((void *)dec_state->mem_syn_hf, 2464f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 0, 2474f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber M16k*sizeof(*dec_state->mem_syn_hf)); 2484f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2494f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pv_memset((void *)dec_state->mem_syn_hi, 2504f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 0, 2514f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber M*sizeof(*dec_state->mem_syn_hi)); 2524f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2534f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pv_memset((void *)dec_state->mem_syn_lo, 2544f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 0, 2554f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber M*sizeof(*dec_state->mem_syn_lo)); 2564f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2574f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2584f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber dtx_dec_amr_wb_reset(&(dec_state->dtx_decSt), isf_init); 2594f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber dec_state->vad_hist = 0; 2604f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2614f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 2624f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber return; 2634f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber} 2644f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2654f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 2664f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; FUNCTION CODE 2674f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 2684f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2694f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huberint32 pvDecoder_AmrWbMemRequirements() 2704f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber{ 2714f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber return(sizeof(PV_AmrWbDec)); 2724f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber} 2734f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2744f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2754f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 2764f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; FUNCTION CODE 2774f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 2784f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2794f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/* Main decoder routine. */ 2804f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2814f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huberint32 pvDecoder_AmrWb( 2824f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 mode, /* input : used mode */ 2834f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 prms[], /* input : parameter vector */ 2844f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 synth16k[], /* output: synthesis speech */ 2854f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 * frame_length, /* output: lenght of the frame */ 2864f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber void *spd_state, /* i/o : State structure */ 2874f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 frame_type, /* input : received frame type */ 2884f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 ScratchMem[] 2894f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber) 2904f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber{ 2914f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2924f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Decoder states */ 2934f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Decoder_State *st; 2944f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2954f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 *ScratchMem2 = &ScratchMem[ L_SUBFR + L_SUBFR16k + ((L_SUBFR + M + M16k +1)<<1)]; 2964f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2974f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2984f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Excitation vector */ 2994f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3004f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3014f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 *old_exc = ScratchMem2; 3024f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3034f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 *Aq = &old_exc[(L_FRAME + 1) + PIT_MAX + L_INTERPOL];/* A(z) quantized for the 4 subframes */ 3044f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3054f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 *ispnew = &Aq[NB_SUBFR * (M + 1)];/* immittance spectral pairs at 4nd sfr */ 3064f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 *isf = &ispnew[M]; /* ISF (frequency domain) at 4nd sfr */ 3074f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 *isf_tmp = &isf[M]; 3084f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 *code = &isf_tmp[M]; /* algebraic codevector */ 3094f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 *excp = &code[L_SUBFR]; 3104f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 *exc2 = &excp[L_SUBFR]; /* excitation vector */ 3114f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 *HfIsf = &exc2[L_FRAME]; 3124f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3134f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3144f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 *exc; 3154f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3164f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* LPC coefficients */ 3174f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3184f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 *p_Aq; /* ptr to A(z) for the 4 subframes */ 3194f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3204f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3214f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3224f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 fac, stab_fac, voice_fac, Q_new = 0; 3234f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int32 L_tmp, L_gain_code; 3244f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3254f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Scalars */ 3264f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3274f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 i, j, i_subfr, index, ind[8], tmp; 3284f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int32 max; 3294f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 T0, T0_frac, pit_flag, T0_max, select, T0_min = 0; 3304f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 gain_pit, gain_code; 3314f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 newDTXState, bfi, unusable_frame, nb_bits; 3324f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 vad_flag; 3334f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 pit_sharp; 3344f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3354f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 corr_gain = 0; 3364f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3374f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st = (Decoder_State *) spd_state; 3384f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3394f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* mode verification */ 3404f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3414f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber nb_bits = AMR_WB_COMPRESSED[mode]; 3424f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3434f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber *frame_length = AMR_WB_PCM_FRAME; 3444f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3454f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* find the new DTX state SPEECH OR DTX */ 3464f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber newDTXState = rx_amr_wb_dtx_handler(&(st->dtx_decSt), frame_type); 3474f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3484f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3494f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (newDTXState != SPEECH) 3504f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 3514f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber dtx_dec_amr_wb(&(st->dtx_decSt), exc2, newDTXState, isf, &prms); 3524f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 3534f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* SPEECH action state machine */ 3544f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3554f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if ((frame_type == RX_SPEECH_BAD) || 3564f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber (frame_type == RX_SPEECH_PROBABLY_DEGRADED)) 3574f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 3584f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* bfi for all index, bits are not usable */ 3594f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber bfi = 1; 3604f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber unusable_frame = 0; 3614f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 3624f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else if ((frame_type == RX_NO_DATA) || 3634f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber (frame_type == RX_SPEECH_LOST)) 3644f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 3654f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* bfi only for lsf, gains and pitch period */ 3664f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber bfi = 1; 3674f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber unusable_frame = 1; 3684f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 3694f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else 3704f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 3714f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber bfi = 0; 3724f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber unusable_frame = 0; 3734f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 3744f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3754f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (bfi != 0) 3764f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 3774f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->state += 1; 3784f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3794f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (st->state > 6) 3804f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 3814f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->state = 6; 3824f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 3834f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 3844f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else 3854f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 3864f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->state >>= 1; 3874f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 3884f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3894f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* If this frame is the first speech frame after CNI period, 3904f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * set the BFH state machine to an appropriate state depending 3914f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * on whether there was DTX muting before start of speech or not 3924f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * If there was DTX muting, the first speech frame is muted. 3934f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * If there was no DTX muting, the first speech frame is not 3944f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * muted. The BFH state machine starts from state 5, however, to 3954f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * keep the audible noise resulting from a SID frame which is 3964f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * erroneously interpreted as a good speech frame as small as 3974f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * possible (the decoder output in this case is quickly muted) 3984f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber */ 3994f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4004f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (st->dtx_decSt.dtxGlobalState == DTX) 4014f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 4024f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->state = 5; 4034f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->prev_bfi = 0; 4044f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 4054f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else if (st->dtx_decSt.dtxGlobalState == DTX_MUTE) 4064f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 4074f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->state = 5; 4084f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->prev_bfi = 1; 4094f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 4104f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4114f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (newDTXState == SPEECH) 4124f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 4134f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber vad_flag = Serial_parm_1bit(&prms); 4144f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4154f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (bfi == 0) 4164f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 4174f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (vad_flag == 0) 4184f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 4194f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->vad_hist = add_int16(st->vad_hist, 1); 4204f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 4214f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else 4224f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 4234f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->vad_hist = 0; 4244f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 4254f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 4264f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 4274f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* 4284f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * DTX-CNG 4294f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber */ 4304f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4314f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (newDTXState != SPEECH) /* CNG mode */ 4324f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 4334f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* increase slightly energy of noise below 200 Hz */ 4344f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4354f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Convert ISFs to the cosine domain */ 4364f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Isf_isp(isf, ispnew, M); 4374f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4384f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Isp_Az(ispnew, Aq, M, 1); 4394f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4404f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pv_memcpy((void *)isf_tmp, (void *)st->isfold, M*sizeof(*isf_tmp)); 4414f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4424f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4434f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i_subfr = 0; i_subfr < L_FRAME; i_subfr += L_SUBFR) 4444f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 4454f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber j = i_subfr >> 6; 4464f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4474f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = 0; i < M; i++) 4484f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 4494f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = mul_16by16_to_int32(isf_tmp[i], sub_int16(32767, interpol_frac[j])); 4504f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = mac_16by16_to_int32(L_tmp, isf[i], interpol_frac[j]); 4514f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber HfIsf[i] = amr_wb_round(L_tmp); 4524f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 4534f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4544f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber synthesis_amr_wb(Aq, 4554f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber &exc2[i_subfr], 4564f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 0, 4574f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber &synth16k[i_subfr *5/4], 4584f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber (short) 1, 4594f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber HfIsf, 4604f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber nb_bits, 4614f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber newDTXState, 4624f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st, 4634f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber bfi, 4644f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ScratchMem); 4654f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 4664f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4674f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* reset speech coder memories */ 4684f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pvDecoder_AmrWb_Reset(st, 0); 4694f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4704f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pv_memcpy((void *)st->isfold, (void *)isf, M*sizeof(*isf)); 4714f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4724f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->prev_bfi = bfi; 4734f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->dtx_decSt.dtxGlobalState = newDTXState; 4744f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4754f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber return 0; 4764f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 4774f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* 4784f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * ACELP 4794f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber */ 4804f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4814f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* copy coder memory state into working space (internal memory for DSP) */ 4824f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4834f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pv_memcpy((void *)old_exc, (void *)st->old_exc, (PIT_MAX + L_INTERPOL)*sizeof(*old_exc)); 4844f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4854f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber exc = old_exc + PIT_MAX + L_INTERPOL; 4864f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4874f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Decode the ISFs */ 4884f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4894f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (nb_bits > NBBITS_7k) /* all rates but 6.6 Kbps */ 4904f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 4914f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ind[0] = Serial_parm(8, &prms); /* index of 1st ISP subvector */ 4924f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ind[1] = Serial_parm(8, &prms); /* index of 2nd ISP subvector */ 4934f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ind[2] = Serial_parm(6, &prms); /* index of 3rd ISP subvector */ 4944f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ind[3] = Serial_parm(7, &prms); /* index of 4th ISP subvector */ 4954f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ind[4] = Serial_parm(7, &prms); /* index of 5th ISP subvector */ 4964f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ind[5] = Serial_parm(5, &prms); /* index of 6th ISP subvector */ 4974f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ind[6] = Serial_parm(5, &prms); /* index of 7th ISP subvector */ 4984f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 4994f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Dpisf_2s_46b(ind, isf, st->past_isfq, st->isfold, st->isf_buf, bfi, 1); 5004f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 5014f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else 5024f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 5034f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ind[0] = Serial_parm(8, &prms); 5044f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ind[1] = Serial_parm(8, &prms); 5054f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ind[2] = Serial_parm(14, &prms); 5064f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ind[3] = ind[2] & 0x007F; 5074f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ind[2] >>= 7; 5084f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ind[4] = Serial_parm(6, &prms); 5094f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5104f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Dpisf_2s_36b(ind, isf, st->past_isfq, st->isfold, st->isf_buf, bfi, 1); 5114f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 5124f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5134f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Convert ISFs to the cosine domain */ 5144f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5154f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Isf_isp(isf, ispnew, M); 5164f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5174f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (st->first_frame != 0) 5184f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 5194f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->first_frame = 0; 5204f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pv_memcpy((void *)st->ispold, (void *)ispnew, M*sizeof(*ispnew)); 5214f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5224f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 5234f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Find the interpolated ISPs and convert to a[] for all subframes */ 5244f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber interpolate_isp(st->ispold, ispnew, interpol_frac, Aq); 5254f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5264f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* update ispold[] for the next frame */ 5274f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pv_memcpy((void *)st->ispold, (void *)ispnew, M*sizeof(*ispnew)); 5284f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5294f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* Check stability on isf : distance between old isf and current isf */ 5304f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5314f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = 0; 5324f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = 0; i < M - 1; i++) 5334f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 5344f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber tmp = sub_int16(isf[i], st->isfold[i]); 5354f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = mac_16by16_to_int32(L_tmp, tmp, tmp); 5364f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 5374f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber tmp = extract_h(shl_int32(L_tmp, 8)); 5384f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber tmp = mult_int16(tmp, 26214); /* tmp = L_tmp*0.8/256 */ 5394f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5404f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber tmp = 20480 - tmp; /* 1.25 - tmp */ 5414f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber stab_fac = shl_int16(tmp, 1); /* Q14 -> Q15 with saturation */ 5424f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5434f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (stab_fac < 0) 5444f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 5454f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber stab_fac = 0; 5464f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 5474f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pv_memcpy((void *)isf_tmp, (void *)st->isfold, M*sizeof(*isf_tmp)); 5484f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5494f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pv_memcpy((void *)st->isfold, (void *)isf, M*sizeof(*isf)); 5504f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5514f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* 5524f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * Loop for every subframe in the analysis frame 5534f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 5544f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * The subframe size is L_SUBFR and the loop is repeated L_FRAME/L_SUBFR 5554f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * times 5564f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * - decode the pitch delay and filter mode 5574f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * - decode algebraic code 5584f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * - decode pitch and codebook gains 5594f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * - find voicing factor and tilt of code for next subframe. 5604f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * - find the excitation and compute synthesis speech 5614f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber */ 5624f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5634f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber p_Aq = Aq; /* pointer to interpolated LPC parameters */ 5644f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5654f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5664f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* 5674f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * Sub process next 3 subframes 5684f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber */ 5694f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5704f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5714f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i_subfr = 0; i_subfr < L_FRAME; i_subfr += L_SUBFR) 5724f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 5734f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pit_flag = i_subfr; 5744f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5754f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5764f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if ((i_subfr == 2*L_SUBFR) && (nb_bits > NBBITS_7k)) 5774f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 5784f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pit_flag = 0; /* set to 0 for 3rd subframe, <=> is not 6.6 kbps */ 5794f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 5804f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /*-------------------------------------------------* 5814f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * - Decode pitch lag * 5824f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * Lag indeces received also in case of BFI, * 5834f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * so that the parameter pointer stays in sync. * 5844f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber *-------------------------------------------------*/ 5854f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5864f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (pit_flag == 0) 5874f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 5884f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5894f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (nb_bits <= NBBITS_9k) 5904f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 5914f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber index = Serial_parm(8, &prms); 5924f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 5934f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (index < (PIT_FR1_8b - PIT_MIN) * 2) 5944f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 5954f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber T0 = PIT_MIN + (index >> 1); 5964f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber T0_frac = sub_int16(index, shl_int16(sub_int16(T0, PIT_MIN), 1)); 5974f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber T0_frac = shl_int16(T0_frac, 1); 5984f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 5994f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else 6004f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 6014f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber T0 = add_int16(index, PIT_FR1_8b - ((PIT_FR1_8b - PIT_MIN) * 2)); 6024f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber T0_frac = 0; 6034f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 6044f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 6054f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else 6064f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 6074f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber index = Serial_parm(9, &prms); 6084f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 6094f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (index < (PIT_FR2 - PIT_MIN) * 4) 6104f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 6114f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber T0 = PIT_MIN + (index >> 2); 6124f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber T0_frac = sub_int16(index, shl_int16(sub_int16(T0, PIT_MIN), 2)); 6134f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 6144f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else if (index < (((PIT_FR2 - PIT_MIN) << 2) + ((PIT_FR1_9b - PIT_FR2) << 1))) 6154f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 6164f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber index -= (PIT_FR2 - PIT_MIN) << 2; 6174f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber T0 = PIT_FR2 + (index >> 1); 6184f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber T0_frac = sub_int16(index, shl_int16(sub_int16(T0, PIT_FR2), 1)); 6194f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber T0_frac = shl_int16(T0_frac, 1); 6204f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 6214f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else 6224f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 6234f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber T0 = add_int16(index, (PIT_FR1_9b - ((PIT_FR2 - PIT_MIN) * 4) - ((PIT_FR1_9b - PIT_FR2) * 2))); 6244f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber T0_frac = 0; 6254f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 6264f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 6274f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 6284f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* find T0_min and T0_max for subframe 2 and 4 */ 6294f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 6304f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber T0_min = T0 - 8; 6314f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 6324f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (T0_min < PIT_MIN) 6334f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 6344f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber T0_min = PIT_MIN; 6354f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 6364f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber T0_max = T0_min + 15; 6374f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 6384f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (T0_max > PIT_MAX) 6394f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 6404f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber T0_max = PIT_MAX; 6414f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber T0_min = PIT_MAX - 15; 6424f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 6434f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 6444f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else 6454f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { /* if subframe 2 or 4 */ 6464f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 6474f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (nb_bits <= NBBITS_9k) 6484f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 6494f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber index = Serial_parm(5, &prms); 6504f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 6514f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber T0 = T0_min + (index >> 1); 6524f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber T0_frac = sub_int16(index, shl_int16(T0 - T0_min, 1)); 6534f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber T0_frac = shl_int16(T0_frac, 1); 6544f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 6554f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else 6564f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 6574f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber index = Serial_parm(6, &prms); 6584f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 6594f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber T0 = T0_min + (index >> 2); 6604f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber T0_frac = sub_int16(index, shl_int16(T0 - T0_min, 2)); 6614f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 6624f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 6634f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 6644f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* check BFI after pitch lag decoding */ 6654f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 6664f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (bfi != 0) /* if frame erasure */ 6674f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 6684f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber lagconceal(&(st->dec_gain[17]), st->lag_hist, &T0, &(st->old_T0), &(st->seed3), unusable_frame); 6694f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber T0_frac = 0; 6704f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 6714f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* 6724f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * Find the pitch gain, the interpolation filter 6734f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * and the adaptive codebook vector. 6744f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber */ 6754f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 6764f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Pred_lt4(&exc[i_subfr], T0, T0_frac, L_SUBFR + 1); 6774f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 6784f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 6794f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (unusable_frame) 6804f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 6814f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber select = 1; 6824f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 6834f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else 6844f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 6854f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 6864f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (nb_bits <= NBBITS_9k) 6874f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 6884f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber select = 0; 6894f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 6904f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else 6914f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 6924f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber select = Serial_parm_1bit(&prms); 6934f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 6944f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 6954f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 6964f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 6974f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (select == 0) 6984f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 6994f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* find pitch excitation with lp filter */ 7004f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = 0; i < L_SUBFR; i++) 7014f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 7024f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = ((int32) exc[i-1+i_subfr] + exc[i+1+i_subfr]); 7034f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp *= 5898; 7044f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp += ((int32) exc[i+i_subfr] * 20972); 7054f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 7064f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber code[i] = amr_wb_round(L_tmp << 1); 7074f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 7084f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pv_memcpy((void *)&exc[i_subfr], (void *)code, L_SUBFR*sizeof(*code)); 7094f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 7104f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 7114f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* 7124f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * Decode innovative codebook. 7134f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * Add the fixed-gain pitch contribution to code[]. 7144f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber */ 7154f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 7164f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (unusable_frame != 0) 7174f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 7184f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* the innovative code doesn't need to be scaled (see Q_gain2) */ 7194f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = 0; i < L_SUBFR; i++) 7204f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 7214f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber code[i] = noise_gen_amrwb(&(st->seed)) >> 3; 7224f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 7234f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 7244f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else if (nb_bits <= NBBITS_7k) 7254f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 7264f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ind[0] = Serial_parm(12, &prms); 7274f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber dec_acelp_2p_in_64(ind[0], code); 7284f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 7294f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else if (nb_bits <= NBBITS_9k) 7304f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 7314f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = 0; i < 4; i++) 7324f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 7334f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ind[i] = Serial_parm(5, &prms); 7344f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 7354f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber dec_acelp_4p_in_64(ind, 20, code); 7364f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 7374f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else if (nb_bits <= NBBITS_12k) 7384f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 7394f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = 0; i < 4; i++) 7404f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 7414f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ind[i] = Serial_parm(9, &prms); 7424f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 7434f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber dec_acelp_4p_in_64(ind, 36, code); 7444f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 7454f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else if (nb_bits <= NBBITS_14k) 7464f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 7474f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ind[0] = Serial_parm(13, &prms); 7484f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ind[1] = Serial_parm(13, &prms); 7494f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ind[2] = Serial_parm(9, &prms); 7504f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ind[3] = Serial_parm(9, &prms); 7514f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber dec_acelp_4p_in_64(ind, 44, code); 7524f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 7534f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else if (nb_bits <= NBBITS_16k) 7544f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 7554f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = 0; i < 4; i++) 7564f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 7574f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ind[i] = Serial_parm(13, &prms); 7584f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 7594f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber dec_acelp_4p_in_64(ind, 52, code); 7604f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 7614f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else if (nb_bits <= NBBITS_18k) 7624f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 7634f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = 0; i < 4; i++) 7644f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 7654f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ind[i] = Serial_parm(2, &prms); 7664f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 7674f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = 4; i < 8; i++) 7684f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 7694f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ind[i] = Serial_parm(14, &prms); 7704f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 7714f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber dec_acelp_4p_in_64(ind, 64, code); 7724f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 7734f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else if (nb_bits <= NBBITS_20k) 7744f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 7754f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ind[0] = Serial_parm(10, &prms); 7764f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ind[1] = Serial_parm(10, &prms); 7774f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ind[2] = Serial_parm(2, &prms); 7784f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ind[3] = Serial_parm(2, &prms); 7794f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ind[4] = Serial_parm(10, &prms); 7804f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ind[5] = Serial_parm(10, &prms); 7814f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ind[6] = Serial_parm(14, &prms); 7824f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ind[7] = Serial_parm(14, &prms); 7834f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber dec_acelp_4p_in_64(ind, 72, code); 7844f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 7854f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else 7864f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 7874f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = 0; i < 8; i++) 7884f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 7894f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ind[i] = Serial_parm(11, &prms); 7904f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 7914f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 7924f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber dec_acelp_4p_in_64(ind, 88, code); 7934f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 7944f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 7954f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber preemph_amrwb_dec(code, st->tilt_code, L_SUBFR); 7964f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 7974f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber tmp = T0; 7984f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 7994f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (T0_frac > 2) 8004f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 8014f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber tmp++; 8024f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 8034f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Pit_shrp(code, tmp, PIT_SHARP, L_SUBFR); 8044f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 8054f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* 8064f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * Decode codebooks gains. 8074f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber */ 8084f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 8094f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (nb_bits <= NBBITS_9k) 8104f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 8114f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber index = Serial_parm(6, &prms); /* codebook gain index */ 8124f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 8134f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber dec_gain2_amr_wb(index, 8144f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 6, 8154f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber code, 8164f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_SUBFR, 8174f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber &gain_pit, 8184f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber &L_gain_code, 8194f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber bfi, 8204f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->prev_bfi, 8214f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->state, 8224f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber unusable_frame, 8234f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->vad_hist, 8244f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->dec_gain); 8254f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 8264f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else 8274f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 8284f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber index = Serial_parm(7, &prms); /* codebook gain index */ 8294f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 8304f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber dec_gain2_amr_wb(index, 8314f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 7, 8324f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber code, 8334f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_SUBFR, 8344f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber &gain_pit, 8354f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber &L_gain_code, 8364f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber bfi, 8374f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->prev_bfi, 8384f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->state, 8394f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber unusable_frame, 8404f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->vad_hist, 8414f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->dec_gain); 8424f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 8434f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 8444f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* find best scaling to perform on excitation (Q_new) */ 8454f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 8464f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber tmp = st->Qsubfr[0]; 8474f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = 1; i < 4; i++) 8484f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 8494f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (st->Qsubfr[i] < tmp) 8504f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 8514f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber tmp = st->Qsubfr[i]; 8524f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 8534f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 8544f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 8554f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* limit scaling (Q_new) to Q_MAX: see pv_amr_wb_cnst.h and syn_filt_32() */ 8564f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 8574f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (tmp > Q_MAX) 8584f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 8594f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber tmp = Q_MAX; 8604f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 8614f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Q_new = 0; 8624f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = L_gain_code; /* L_gain_code in Q16 */ 8634f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 8644f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 8654f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber while ((L_tmp < 0x08000000L) && (Q_new < tmp)) 8664f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 8674f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp <<= 1; 8684f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Q_new += 1; 8694f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 8704f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 8714f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber gain_code = amr_wb_round(L_tmp); /* scaled gain_code with Qnew */ 8724f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 8734f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber scale_signal(exc + i_subfr - (PIT_MAX + L_INTERPOL), 8744f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber PIT_MAX + L_INTERPOL + L_SUBFR, 8754f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber (int16)(Q_new - st->Q_old)); 8764f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 8774f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->Q_old = Q_new; 8784f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 8794f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 8804f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* 8814f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * Update parameters for the next subframe. 8824f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * - tilt of code: 0.0 (unvoiced) to 0.5 (voiced) 8834f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber */ 8844f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 8854f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 8864f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (bfi == 0) 8874f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 8884f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* LTP-Lag history update */ 8894f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = 4; i > 0; i--) 8904f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 8914f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->lag_hist[i] = st->lag_hist[i - 1]; 8924f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 8934f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->lag_hist[0] = T0; 8944f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 8954f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->old_T0 = T0; 8964f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->old_T0_frac = 0; /* Remove fraction in case of BFI */ 8974f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 8984f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* find voice factor in Q15 (1=voiced, -1=unvoiced) */ 8994f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 9004f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* 9014f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * Scale down by 1/8 9024f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber */ 9034f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = L_SUBFR - 1; i >= 0; i--) 9044f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 9054f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber exc2[i] = (exc[i_subfr + i] + (0x0004 * (exc[i_subfr + i] != MAX_16))) >> 3; 9064f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 9074f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 9084f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 9094f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* post processing of excitation elements */ 9104f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 9114f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (nb_bits <= NBBITS_9k) 9124f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 9134f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pit_sharp = shl_int16(gain_pit, 1); 9144f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 9154f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (pit_sharp > 16384) 9164f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 9174f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = 0; i < L_SUBFR; i++) 9184f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 9194f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber tmp = mult_int16(exc2[i], pit_sharp); 9204f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = mul_16by16_to_int32(tmp, gain_pit); 9214f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp >>= 1; 9224f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber excp[i] = amr_wb_round(L_tmp); 9234f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 9244f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 9254f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 9264f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else 9274f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 9284f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pit_sharp = 0; 9294f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 9304f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 9314f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber voice_fac = voice_factor(exc2, -3, gain_pit, code, gain_code, L_SUBFR); 9324f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 9334f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* tilt of code for next subframe: 0.5=voiced, 0=unvoiced */ 9344f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 9354f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->tilt_code = (voice_fac >> 2) + 8192; 9364f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 9374f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* 9384f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * - Find the total excitation. 9394f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * - Find synthesis speech corresponding to exc[]. 9404f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * - Find maximum value of excitation for next scaling 9414f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber */ 9424f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 9434f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pv_memcpy((void *)exc2, (void *)&exc[i_subfr], L_SUBFR*sizeof(*exc2)); 9444f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber max = 1; 9454f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 9464f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = 0; i < L_SUBFR; i++) 9474f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 9484f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = mul_16by16_to_int32(code[i], gain_code); 9494f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = shl_int32(L_tmp, 5); 9504f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = mac_16by16_to_int32(L_tmp, exc[i + i_subfr], gain_pit); 9514f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = shl_int32(L_tmp, 1); 9524f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber tmp = amr_wb_round(L_tmp); 9534f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber exc[i + i_subfr] = tmp; 9544f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber tmp = tmp - (tmp < 0); 9554f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber max |= tmp ^(tmp >> 15); /* |= tmp ^sign(tmp) */ 9564f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 9574f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 9584f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 9594f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* tmp = scaling possible according to max value of excitation */ 9604f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber tmp = add_int16(norm_s(max), Q_new) - 1; 9614f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 9624f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->Qsubfr[3] = st->Qsubfr[2]; 9634f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->Qsubfr[2] = st->Qsubfr[1]; 9644f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->Qsubfr[1] = st->Qsubfr[0]; 9654f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->Qsubfr[0] = tmp; 9664f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 9674f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* 9684f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * phase dispersion to enhance noise in low bit rate 9694f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber */ 9704f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 9714f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 9724f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (nb_bits <= NBBITS_7k) 9734f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 9744f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber j = 0; /* high dispersion for rate <= 7.5 kbit/s */ 9754f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 9764f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else if (nb_bits <= NBBITS_9k) 9774f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 9784f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber j = 1; /* low dispersion for rate <= 9.6 kbit/s */ 9794f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 9804f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else 9814f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 9824f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber j = 2; /* no dispersion for rate > 9.6 kbit/s */ 9834f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 9844f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 9854f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* L_gain_code in Q16 */ 9864f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 9874f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber phase_dispersion((int16)(L_gain_code >> 16), 9884f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber gain_pit, 9894f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber code, 9904f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber j, 9914f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->disp_mem, 9924f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ScratchMem); 9934f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 9944f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* 9954f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * noise enhancer 9964f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * - Enhance excitation on noise. (modify gain of code) 9974f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * If signal is noisy and LPC filter is stable, move gain 9984f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * of code 1.5 dB toward gain of code threshold. 9994f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * This decrease by 3 dB noise energy variation. 10004f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber */ 10014f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 10024f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber tmp = 16384 - (voice_fac >> 1); /* 1=unvoiced, 0=voiced */ 10034f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber fac = mult_int16(stab_fac, tmp); 10044f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 10054f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = L_gain_code; 10064f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 10074f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (L_tmp < st->L_gc_thres) 10084f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 10094f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp += fxp_mul32_by_16b(L_gain_code, 6226) << 1; 10104f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 10114f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (L_tmp > st->L_gc_thres) 10124f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 10134f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = st->L_gc_thres; 10144f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 10154f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 10164f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else 10174f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 10184f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = fxp_mul32_by_16b(L_gain_code, 27536) << 1; 10194f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 10204f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (L_tmp < st->L_gc_thres) 10214f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 10224f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = st->L_gc_thres; 10234f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 10244f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 10254f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->L_gc_thres = L_tmp; 10264f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 10274f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_gain_code = fxp_mul32_by_16b(L_gain_code, (32767 - fac)) << 1; 10284f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 10294f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 10304f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_gain_code = add_int32(L_gain_code, fxp_mul32_by_16b(L_tmp, fac) << 1); 10314f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 10324f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* 10334f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * pitch enhancer 10344f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * - Enhance excitation on voice. (HP filtering of code) 10354f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * On voiced signal, filtering of code by a smooth fir HP 10364f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * filter to decrease energy of code in low frequency. 10374f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber */ 10384f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 10394f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber tmp = (voice_fac >> 3) + 4096;/* 0.25=voiced, 0=unvoiced */ 10404f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 10414f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* build excitation */ 10424f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 10434f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber gain_code = amr_wb_round(shl_int32(L_gain_code, Q_new)); 10444f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 10454f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = (int32)(code[0] << 16); 10464f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = msu_16by16_from_int32(L_tmp, code[1], tmp); 10474f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = mul_16by16_to_int32(amr_wb_round(L_tmp), gain_code); 10484f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = shl_int32(L_tmp, 5); 10494f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = mac_16by16_to_int32(L_tmp, exc2[0], gain_pit); 10504f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = shl_int32(L_tmp, 1); /* saturation can occur here */ 10514f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber exc2[0] = amr_wb_round(L_tmp); 10524f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 10534f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 10544f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = 1; i < L_SUBFR - 1; i++) 10554f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 10564f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = (int32)(code[i] << 16); 10574f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = msu_16by16_from_int32(L_tmp, (code[i + 1] + code[i - 1]), tmp); 10584f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = mul_16by16_to_int32(amr_wb_round(L_tmp), gain_code); 10594f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = shl_int32(L_tmp, 5); 10604f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = mac_16by16_to_int32(L_tmp, exc2[i], gain_pit); 10614f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = shl_int32(L_tmp, 1); /* saturation can occur here */ 10624f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber exc2[i] = amr_wb_round(L_tmp); 10634f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 10644f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 10654f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = (int32)(code[L_SUBFR - 1] << 16); 10664f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = msu_16by16_from_int32(L_tmp, code[L_SUBFR - 2], tmp); 10674f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = mul_16by16_to_int32(amr_wb_round(L_tmp), gain_code); 10684f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = shl_int32(L_tmp, 5); 10694f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = mac_16by16_to_int32(L_tmp, exc2[L_SUBFR - 1], gain_pit); 10704f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = shl_int32(L_tmp, 1); /* saturation can occur here */ 10714f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber exc2[L_SUBFR - 1] = amr_wb_round(L_tmp); 10724f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 10734f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 10744f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 10754f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (nb_bits <= NBBITS_9k) 10764f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 10774f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (pit_sharp > 16384) 10784f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 10794f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = 0; i < L_SUBFR; i++) 10804f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 10814f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber excp[i] = add_int16(excp[i], exc2[i]); 10824f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 10834f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber agc2_amr_wb(exc2, excp, L_SUBFR); 10844f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pv_memcpy((void *)exc2, (void *)excp, L_SUBFR*sizeof(*exc2)); 10854f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 10864f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 10874f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 10884f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (nb_bits <= NBBITS_7k) 10894f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 10904f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber j = i_subfr >> 6; 10914f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = 0; i < M; i++) 10924f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 10934f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = mul_16by16_to_int32(isf_tmp[i], sub_int16(32767, interpol_frac[j])); 10944f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp = mac_16by16_to_int32(L_tmp, isf[i], interpol_frac[j]); 10954f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber HfIsf[i] = amr_wb_round(L_tmp); 10964f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 10974f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 10984f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else 10994f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 11004f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pv_memset((void *)st->mem_syn_hf, 11014f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 0, 11024f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber (M16k - M)*sizeof(*st->mem_syn_hf)); 11034f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 11044f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 11054f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber if (nb_bits >= NBBITS_24k) 11064f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 11074f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber corr_gain = Serial_parm(4, &prms); 11084f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 11094f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber else 11104f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 11114f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber corr_gain = 0; 11124f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 11134f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 11144f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber synthesis_amr_wb(p_Aq, 11154f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber exc2, 11164f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Q_new, 11174f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber &synth16k[i_subfr + (i_subfr>>2)], 11184f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber corr_gain, 11194f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber HfIsf, 11204f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber nb_bits, 11214f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber newDTXState, 11224f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st, 11234f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber bfi, 11244f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ScratchMem); 11254f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 11264f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber p_Aq += (M + 1); /* interpolated LPC parameters for next subframe */ 11274f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 11284f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 11294f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* 11304f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * Update signal for next frame. 11314f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * -> save past of exc[] 11324f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * -> save pitch parameters 11334f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber */ 11344f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 11354f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pv_memcpy((void *)st->old_exc, 11364f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber (void *)&old_exc[L_FRAME], 11374f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber (PIT_MAX + L_INTERPOL)*sizeof(*old_exc)); 11384f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 11394f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber scale_signal(exc, L_FRAME, (int16)(-Q_new)); 11404f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 11414f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber dtx_dec_amr_wb_activity_update(&(st->dtx_decSt), isf, exc); 11424f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 11434f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->dtx_decSt.dtxGlobalState = newDTXState; 11444f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 11454f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber st->prev_bfi = bfi; 11464f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 11474f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber return 0; 11484f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber} 11494f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1150