1a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/* ------------------------------------------------------------------ 2a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * Copyright (C) 1998-2009 PacketVideo 3a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * 4a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * Licensed under the Apache License, Version 2.0 (the "License"); 5a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * you may not use this file except in compliance with the License. 6a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * You may obtain a copy of the License at 7a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * 8a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * http://www.apache.org/licenses/LICENSE-2.0 9a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * 10a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * Unless required by applicable law or agreed to in writing, software 11a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * distributed under the License is distributed on an "AS IS" BASIS, 12a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either 13a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * express or implied. 14a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * See the License for the specific language governing permissions 15a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * and limitations under the License. 16a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * ------------------------------------------------------------------- 17a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber */ 18a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/**************************************************************************************** 19a30d40083856cb4edd225faf8b488fab156e5976Andreas HuberPortions of this file are derived from the following 3GPP standard: 20a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 21a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 3GPP TS 26.173 22a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber ANSI-C code for the Adaptive Multi-Rate - Wideband (AMR-WB) speech codec 23a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Available from http://www.3gpp.org 24a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 25a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber(C) 2007, 3GPP Organizational Partners (ARIB, ATIS, CCSA, ETSI, TTA, TTC) 26a30d40083856cb4edd225faf8b488fab156e5976Andreas HuberPermission to distribute, modify and use this file under the standard license 27a30d40083856cb4edd225faf8b488fab156e5976Andreas Huberterms listed above has been obtained from the copyright holder. 28a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber****************************************************************************************/ 29a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/* 30a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------ 31a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 32a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 33a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 34a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Filename: phase_dispersion.cpp 35a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 36a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Date: 05/08/2007 37a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 38a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------ 39a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber REVISION HISTORY 40a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 41a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 42a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Description: 43a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 44a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------ 45a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber INPUT AND OUTPUT DEFINITIONS 46a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 47a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 gain_code, (i) Q0 : gain of code 48a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 gain_pit, (i) Q14 : gain of pitch 49a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 code[], (i/o) : code vector 50a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 mode, (i) : level, 0=hi, 1=lo, 2=off 51a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 disp_mem[], (i/o) : static memory (size = 8) 52a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 ScratchMem[] 53a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 54a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------ 55a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber FUNCTION DESCRIPTION 56a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 57a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber post-processing to enhance noise in low bit rate. 58a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 59a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------ 60a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber REQUIREMENTS 61a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 62a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 63a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------ 64a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber REFERENCES 65a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 66a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------ 67a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber PSEUDO-CODE 68a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 69a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------ 70a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber*/ 71a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 72a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 73a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*---------------------------------------------------------------------------- 74a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; INCLUDES 75a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber----------------------------------------------------------------------------*/ 76a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 77a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#include "pv_amr_wb_type_defs.h" 78a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#include "pvamrwbdecoder_basic_op.h" 79a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#include "pvamrwbdecoder_cnst.h" 80a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#include "pvamrwbdecoder_mem_funcs.h" 81a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#include "pvamrwbdecoder_acelp.h" 82a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#include "pvamrwb_math_op.h" 83a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 84a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 85a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*---------------------------------------------------------------------------- 86a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; MACROS 87a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; Define module specific macros here 88a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber----------------------------------------------------------------------------*/ 89a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 90a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 91a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*---------------------------------------------------------------------------- 92a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; DEFINES 93a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; Include all pre-processor statements here. Include conditional 94a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; compile variables also. 95a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber----------------------------------------------------------------------------*/ 96a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#define pitch_0_9 14746 /* 0.9 in Q14 */ 97a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#define pitch_0_6 9830 /* 0.6 in Q14 */ 98a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#define L_SUBFR 64 99a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 100a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*---------------------------------------------------------------------------- 101a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; LOCAL FUNCTION DEFINITIONS 102a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; Function Prototype declaration 103a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber----------------------------------------------------------------------------*/ 104a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 105a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*---------------------------------------------------------------------------- 106a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; LOCAL STORE/BUFFER/POINTER DEFINITIONS 107a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; Variable declaration - defined here and used outside this module 108a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber----------------------------------------------------------------------------*/ 109a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/* impulse response with phase dispersion */ 110a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 111a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/* 2.0 - 6.4 kHz phase dispersion */ 112a30d40083856cb4edd225faf8b488fab156e5976Andreas Huberconst int16 ph_imp_low[L_SUBFR] = 113a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber{ 114a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 20182, 9693, 3270, -3437, 2864, -5240, 1589, -1357, 115a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 600, 3893, -1497, -698, 1203, -5249, 1199, 5371, 116a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber -1488, -705, -2887, 1976, 898, 721, -3876, 4227, 117a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber -5112, 6400, -1032, -4725, 4093, -4352, 3205, 2130, 118a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber -1996, -1835, 2648, -1786, -406, 573, 2484, -3608, 119a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 3139, -1363, -2566, 3808, -639, -2051, -541, 2376, 120a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 3932, -6262, 1432, -3601, 4889, 370, 567, -1163, 121a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber -2854, 1914, 39, -2418, 3454, 2975, -4021, 3431 122a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber}; 123a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 124a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/* 3.2 - 6.4 kHz phase dispersion */ 125a30d40083856cb4edd225faf8b488fab156e5976Andreas Huberconst int16 ph_imp_mid[L_SUBFR] = 126a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber{ 127a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 24098, 10460, -5263, -763, 2048, -927, 1753, -3323, 128a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 2212, 652, -2146, 2487, -3539, 4109, -2107, -374, 129a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber -626, 4270, -5485, 2235, 1858, -2769, 744, 1140, 130a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber -763, -1615, 4060, -4574, 2982, -1163, 731, -1098, 131a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 803, 167, -714, 606, -560, 639, 43, -1766, 132a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 3228, -2782, 665, 763, 233, -2002, 1291, 1871, 133a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber -3470, 1032, 2710, -4040, 3624, -4214, 5292, -4270, 134a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 1563, 108, -580, 1642, -2458, 957, 544, 2540 135a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber}; 136a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 137a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*---------------------------------------------------------------------------- 138a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; EXTERNAL FUNCTION REFERENCES 139a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; Declare functions defined elsewhere and referenced in this module 140a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber----------------------------------------------------------------------------*/ 141a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 142a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*---------------------------------------------------------------------------- 143a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; EXTERNAL GLOBAL STORE/BUFFER/POINTER REFERENCES 144a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; Declare variables used in this module but defined elsewhere 145a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber----------------------------------------------------------------------------*/ 146a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 147a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*---------------------------------------------------------------------------- 148a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; FUNCTION CODE 149a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber----------------------------------------------------------------------------*/ 150a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 151a30d40083856cb4edd225faf8b488fab156e5976Andreas Hubervoid phase_dispersion( 152a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 gain_code, /* (i) Q0 : gain of code */ 153a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 gain_pit, /* (i) Q14 : gain of pitch */ 154a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 code[], /* (i/o) : code vector */ 155a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 mode, /* (i) : level, 0=hi, 1=lo, 2=off */ 156a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 disp_mem[], /* (i/o) : static memory (size = 8) */ 157a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 ScratchMem[] 158a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber) 159a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber{ 160a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 i, j, state; 161a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 *prev_gain_pit, *prev_gain_code, *prev_state; 162a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 *code2 = ScratchMem; 163a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 164a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber prev_state = disp_mem; 165a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber prev_gain_code = disp_mem + 1; 166a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber prev_gain_pit = disp_mem + 2; 167a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 168a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber pv_memset((void *)code2, 0, (2*L_SUBFR)*sizeof(*code2)); 169a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 170a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 171a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber if (gain_pit < pitch_0_6) 172a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 173a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber state = 0; 174a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 175a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber else if (gain_pit < pitch_0_9) 176a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 177a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber state = 1; 178a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 179a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber else 180a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 181a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber state = 2; 182a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 183a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 184a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber for (i = 5; i > 0; i--) 185a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 186a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber prev_gain_pit[i] = prev_gain_pit[i - 1]; 187a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 188a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber prev_gain_pit[0] = gain_pit; 189a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 190a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber if (sub_int16(gain_code, *prev_gain_code) > shl_int16(*prev_gain_code, 1)) 191a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 192a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /* onset */ 193a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber if (state < 2) 194a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 195a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber state++; 196a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 197a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 198a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber else 199a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 200a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber j = 0; 201a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber for (i = 0; i < 6; i++) 202a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 203a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber if (prev_gain_pit[i] < pitch_0_6) 204a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 205a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber j++; 206a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 207a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 208a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 209a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber if (j > 2) 210a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 211a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber state = 0; 212a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 213a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber if (state > *prev_state + 1) 214a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 215a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber state--; 216a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 217a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 218a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 219a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *prev_gain_code = gain_code; 220a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *prev_state = state; 221a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 222a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /* circular convolution */ 223a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 224a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber state += mode; /* level of dispersion */ 225a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 226a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber if (state == 0) 227a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 228a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber for (i = 0; i < L_SUBFR; i++) 229a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 230a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber if (code[i] != 0) 231a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 232a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber for (j = 0; j < L_SUBFR; j++) 233a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 234a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber code2[i + j] = add_int16(code2[i + j], mult_int16_r(code[i], ph_imp_low[j])); 235a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 236a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 237a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 238a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 239a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber else if (state == 1) 240a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 241a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber for (i = 0; i < L_SUBFR; i++) 242a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 243a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber if (code[i] != 0) 244a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 245a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber for (j = 0; j < L_SUBFR; j++) 246a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 247a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber code2[i + j] = add_int16(code2[i + j], mult_int16_r(code[i], ph_imp_mid[j])); 248a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 249a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 250a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 251a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 252a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber if (state < 2) 253a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 254a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber for (i = 0; i < L_SUBFR; i++) 255a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 256a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber code[i] = add_int16(code2[i], code2[i + L_SUBFR]); 257a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 258a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 259a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber return; 260a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber} 261a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 262