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.073 22a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber ANSI-C code for the Adaptive Multi-Rate (AMR) speech codec 23a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Available from http://www.3gpp.org 24a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 25a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber(C) 2004, 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 Pathname: ./audio/gsm-amr/c/src/d_plsf_5.c 35a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 36a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Date: 04/24/2000 37a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 38a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------ 39a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber REVISION HISTORY 40a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 41a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Description: Made changes based on review meeting. 42a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 43a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Description: Synchronized file with UMTS version 3.2.0. Updated coding 44a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber template. Removed unnecessary include files. 45a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 46a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Description: Updated to accept new parameter, Flag *pOverflow. 47a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 48a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Description: 49a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber (1) Removed "count.h" and "basic_op.h" and replaced with individual include 50a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber files (add.h, sub.h, etc.) 51a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 52a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Description: Replaced "int" and/or "char" with OSCL defined types. 53a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 54a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Description: Added #ifdef __cplusplus around extern'ed table. 55a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 56a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Description: 57a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 58a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------ 59a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber*/ 60a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 61a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*---------------------------------------------------------------------------- 62a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; INCLUDES 63a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber----------------------------------------------------------------------------*/ 64a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#include "d_plsf.h" 65a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#include "typedef.h" 66a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#include "basic_op.h" 67a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#include "lsp_lsf.h" 68a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#include "reorder.h" 69a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#include "cnst.h" 70a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#include "copy.h" 71a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 72a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*--------------------------------------------------------------------------*/ 73a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#ifdef __cplusplus 74a30d40083856cb4edd225faf8b488fab156e5976Andreas Huberextern "C" 75a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber{ 76a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#endif 77a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 78a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /*---------------------------------------------------------------------------- 79a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber ; MACROS 80a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber ; Define module specific macros here 81a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber ----------------------------------------------------------------------------*/ 82a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 83a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 84a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /*---------------------------------------------------------------------------- 85a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber ; DEFINES 86a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber ; Include all pre-processor statements here. Include conditional 87a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber ; compile variables also. 88a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber ----------------------------------------------------------------------------*/ 89a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /* ALPHA -> 0.95 */ 90a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /* ONE_ALPHA-> (1.0-ALPHA) */ 91a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#define ALPHA 31128 92a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#define ONE_ALPHA 1639 93a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 94a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /*---------------------------------------------------------------------------- 95a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber ; LOCAL FUNCTION DEFINITIONS 96a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber ; Function Prototype declaration 97a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber ----------------------------------------------------------------------------*/ 98a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 99a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /*---------------------------------------------------------------------------- 100a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber ; LOCAL STORE/BUFFER/POINTER DEFINITIONS 101a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber ; Variable declaration - defined here and used outside this module 102a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber ----------------------------------------------------------------------------*/ 103a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 104a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /* These tables are defined in q_plsf_5_tbl.c */ 105a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber extern const Word16 mean_lsf_5[]; 106a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber extern const Word16 dico1_lsf_5[]; 107a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber extern const Word16 dico2_lsf_5[]; 108a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber extern const Word16 dico3_lsf_5[]; 109a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber extern const Word16 dico4_lsf_5[]; 110a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber extern const Word16 dico5_lsf_5[]; 111a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 112a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /*--------------------------------------------------------------------------*/ 113a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#ifdef __cplusplus 114a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber} 115a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#endif 116a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 117a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/* 118a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------ 119a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber FUNCTION NAME: D_plsf_5 120a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------ 121a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber INPUT AND OUTPUT DEFINITIONS 122a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 123a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Inputs: 124a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber st = pointer to a structure of type D_plsfState 125a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber bfi = bad frame indicator; set to 1 if a bad frame is received (Word16) 126a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber indice = pointer to quantization indices of 5 submatrices (Word16) 127a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lsp1_q = pointer to the quantized 1st LSP vector (Word16) 128a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lsp2_q = pointer to the quantized 2nd LSP vector (Word16) 129a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 130a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Outputs: 131a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lsp1_q points to the updated quantized 1st LSP vector 132a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lsp2_q points to the updated quantized 2nd LSP vector 133a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Flag *pOverflow -- Flag set when overflow occurs. 134a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 135a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Returns: 136a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber return_value = 0 (int) 137a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 138a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Global Variables Used: 139a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber None. 140a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 141a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Local Variables Needed: 142a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber None. 143a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 144a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------ 145a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber FUNCTION DESCRIPTION 146a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 147a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber This function decodes the 2 sets of LSP parameters in a frame using the 148a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber received quantization indices. 149a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 150a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------ 151a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber REQUIREMENTS 152a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 153a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber None. 154a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 155a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------ 156a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber REFERENCES 157a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 158a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber d_plsf_5.c, UMTS GSM AMR speech codec, R99 - Version 3.2.0, March 2, 2001 159a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 160a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------ 161a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber PSEUDO-CODE 162a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 163a30d40083856cb4edd225faf8b488fab156e5976Andreas Huberint D_plsf_5 ( 164a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber D_plsfState *st, // i/o: State variables 165a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Word16 bfi, // i : bad frame indicator (set to 1 if a bad 166a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber frame is received) 167a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Word16 *indice, // i : quantization indices of 5 submatrices, Q0 168a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Word16 *lsp1_q, // o : quantized 1st LSP vector (M), Q15 169a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Word16 *lsp2_q // o : quantized 2nd LSP vector (M), Q15 170a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber) 171a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber{ 172a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Word16 i; 173a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber const Word16 *p_dico; 174a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Word16 temp, sign; 175a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Word16 lsf1_r[M], lsf2_r[M]; 176a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Word16 lsf1_q[M], lsf2_q[M]; 177a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 178a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber if (bfi != 0) // if bad frame 179a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 180a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber // use the past LSFs slightly shifted towards their mean 181a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 182a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber for (i = 0; i < M; i++) 183a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 184a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber // lsfi_q[i] = ALPHA*st->past_lsf_q[i] + ONE_ALPHA*mean_lsf[i]; 185a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 186a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lsf1_q[i] = add (mult (st->past_lsf_q[i], ALPHA), 187a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber mult (mean_lsf[i], ONE_ALPHA)); 188a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 189a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lsf2_q[i] = lsf1_q[i]; 190a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 191a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 192a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber // estimate past quantized residual to be used in next frame 193a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 194a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber for (i = 0; i < M; i++) 195a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 196a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber // temp = mean_lsf[i] + st->past_r_q[i] * LSP_PRED_FAC_MR122; 197a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 198a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber temp = add (mean_lsf[i], mult (st->past_r_q[i], 199a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber LSP_PRED_FAC_MR122)); 200a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 201a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber st->past_r_q[i] = sub (lsf2_q[i], temp); 202a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 203a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 204a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber else 205a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber // if good LSFs received 206a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 207a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber // decode prediction residuals from 5 received indices 208a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 209a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber p_dico = &dico1_lsf[shl (indice[0], 2)]; 210a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lsf1_r[0] = *p_dico++; 211a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lsf1_r[1] = *p_dico++; 212a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lsf2_r[0] = *p_dico++; 213a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lsf2_r[1] = *p_dico++; 214a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 215a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber p_dico = &dico2_lsf[shl (indice[1], 2)]; 216a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lsf1_r[2] = *p_dico++; 217a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lsf1_r[3] = *p_dico++; 218a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lsf2_r[2] = *p_dico++; 219a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lsf2_r[3] = *p_dico++; 220a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 221a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber sign = indice[2] & 1; 222a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber i = shr (indice[2], 1); 223a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber p_dico = &dico3_lsf[shl (i, 2)]; 224a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 225a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber if (sign == 0) 226a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 227a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lsf1_r[4] = *p_dico++; 228a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lsf1_r[5] = *p_dico++; 229a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lsf2_r[4] = *p_dico++; 230a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lsf2_r[5] = *p_dico++; 231a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 232a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber else 233a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 234a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lsf1_r[4] = negate (*p_dico++); 235a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lsf1_r[5] = negate (*p_dico++); 236a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lsf2_r[4] = negate (*p_dico++); 237a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lsf2_r[5] = negate (*p_dico++); 238a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 239a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 240a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber p_dico = &dico4_lsf[shl (indice[3], 2)]; 241a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lsf1_r[6] = *p_dico++; 242a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lsf1_r[7] = *p_dico++; 243a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lsf2_r[6] = *p_dico++; 244a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lsf2_r[7] = *p_dico++; 245a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 246a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber p_dico = &dico5_lsf[shl (indice[4], 2)]; 247a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lsf1_r[8] = *p_dico++; 248a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lsf1_r[9] = *p_dico++; 249a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lsf2_r[8] = *p_dico++; 250a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lsf2_r[9] = *p_dico++; 251a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 252a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber // Compute quantized LSFs and update the past quantized residual 253a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber for (i = 0; i < M; i++) 254a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 255a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber temp = add (mean_lsf[i], mult (st->past_r_q[i], 256a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber LSP_PRED_FAC_MR122)); 257a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lsf1_q[i] = add (lsf1_r[i], temp); 258a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lsf2_q[i] = add (lsf2_r[i], temp); 259a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber st->past_r_q[i] = lsf2_r[i]; 260a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 261a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 262a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 263a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber // verification that LSFs have minimum distance of LSF_GAP Hz 264a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 265a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Reorder_lsf (lsf1_q, LSF_GAP, M); 266a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Reorder_lsf (lsf2_q, LSF_GAP, M); 267a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 268a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Copy (lsf2_q, st->past_lsf_q, M); 269a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 270a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber // convert LSFs to the cosine domain 271a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 272a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Lsf_lsp (lsf1_q, lsp1_q, M); 273a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Lsf_lsp (lsf2_q, lsp2_q, M); 274a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 275a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber return 0; 276a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber} 277a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 278a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------ 279a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber RESOURCES USED [optional] 280a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 281a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber When the code is written for a specific target processor the 282a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber the resources used should be documented below. 283a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 284a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber HEAP MEMORY USED: x bytes 285a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 286a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber STACK MEMORY USED: x bytes 287a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 288a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber CLOCK CYCLES: (cycle count equation for this function) + (variable 289a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber used to represent cycle count for each subroutine 290a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber called) 291a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber where: (cycle count variable) = cycle count for [subroutine 292a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber name] 293a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 294a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------ 295a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber CAUTION [optional] 296a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber [State any special notes, constraints or cautions for users of this function] 297a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 298a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------ 299a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber*/ 300a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 301a30d40083856cb4edd225faf8b488fab156e5976Andreas Hubervoid D_plsf_5( 302a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber D_plsfState *st, /* i/o: State variables */ 303a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Word16 bfi, /* i : bad frame indicator (set to 1 if a bad 304a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber frame is received) */ 305a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Word16 *indice, /* i : quantization indices of 5 submatrices, Q0 */ 306a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Word16 *lsp1_q, /* o : quantized 1st LSP vector (M), Q15 */ 307a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Word16 *lsp2_q, /* o : quantized 2nd LSP vector (M), Q15 */ 308a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Flag *pOverflow /* o : Flag set when overflow occurs */ 309a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber) 310a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber{ 311a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber register Word16 i; 312a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Word16 temp; 313a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Word16 sign; 314a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 315a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber const Word16 *p_dico; 316a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 317a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Word16 lsf1_r[M]; 318a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Word16 lsf2_r[M]; 319a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Word16 lsf1_q[M]; 320a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Word16 lsf2_q[M]; 321a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 322a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber if (bfi != 0) /* if bad frame */ 323a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 324a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /* use the past LSFs slightly shifted towards their mean */ 325a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 326a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber for (i = 0; i < M; i++) 327a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 328a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /* 329a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * lsfi_q[i] = ALPHA*st->past_lsf_q[i] + 330a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * ONE_ALPHA*mean_lsf[i]; 331a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber */ 332a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 333a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber temp = 334a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber mult( 335a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber st->past_lsf_q[i], 336a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber ALPHA, 337a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber pOverflow); 338a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 339a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber sign = 340a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber mult( 341a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *(mean_lsf_5 + i), 342a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber ONE_ALPHA, 343a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber pOverflow); 344a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 345a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *(lsf1_q + i) = 346a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber add( 347a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber sign, 348a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber temp, 349a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber pOverflow); 350a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 351a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *(lsf2_q + i) = *(lsf1_q + i); 352a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 353a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /* 354a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * estimate past quantized residual to be used in 355a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * next frame 356a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber */ 357a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 358a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /* 359a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * temp = mean_lsf[i] + 360a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * st->past_r_q[i] * LSP_PRED_FAC_MR122; 361a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber */ 362a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 363a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber temp = 364a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber mult( 365a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber st->past_r_q[i], 366a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber LSP_PRED_FAC_MR122, 367a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber pOverflow); 368a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 369a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber temp = 370a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber add( 371a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *(mean_lsf_5 + i), 372a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber temp, 373a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber pOverflow); 374a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 375a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber st->past_r_q[i] = 376a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber sub( 377a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *(lsf2_q + i), 378a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber temp, 379a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber pOverflow); 380a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 381a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 382a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber else 383a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /* if good LSFs received */ 384a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 385a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /* decode prediction residuals from 5 received indices */ 386a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 387a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber temp = 388a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber shl( 389a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *(indice), 390a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 2, 391a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber pOverflow); 392a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 393a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber p_dico = &dico1_lsf_5[temp]; 394a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 395a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *(lsf1_r + 0) = *p_dico++; 396a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *(lsf1_r + 1) = *p_dico++; 397a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *(lsf2_r + 0) = *p_dico++; 398a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *(lsf2_r + 1) = *p_dico++; 399a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 400a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber temp = 401a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber shl( 402a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *(indice + 1), 403a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 2, 404a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber pOverflow); 405a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 406a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber p_dico = &dico2_lsf_5[temp]; 407a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 408a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *(lsf1_r + 2) = *p_dico++; 409a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *(lsf1_r + 3) = *p_dico++; 410a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *(lsf2_r + 2) = *p_dico++; 411a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *(lsf2_r + 3) = *p_dico++; 412a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 413a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber sign = *(indice + 2) & 1; 414a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 415a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber if (*(indice + 2) < 0) 416a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 417a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber i = ~(~(*(indice + 2)) >> 1); 418a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 419a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber else 420a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 421a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber i = *(indice + 2) >> 1; 422a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 423a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 424a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber temp = 425a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber shl( 426a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber i, 427a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 2, 428a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber pOverflow); 429a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 430a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber p_dico = &dico3_lsf_5[temp]; 431a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 432a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber if (sign == 0) 433a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 434a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *(lsf1_r + 4) = *p_dico++; 435a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *(lsf1_r + 5) = *p_dico++; 436a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *(lsf2_r + 4) = *p_dico++; 437a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *(lsf2_r + 5) = *p_dico++; 438a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 439a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber else 440a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 441a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *(lsf1_r + 4) = negate(*p_dico++); 442a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *(lsf1_r + 5) = negate(*p_dico++); 443a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *(lsf2_r + 4) = negate(*p_dico++); 444a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *(lsf2_r + 5) = negate(*p_dico++); 445a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 446a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 447a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber temp = 448a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber shl( 449a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *(indice + 3), 450a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 2, 451a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber pOverflow); 452a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 453a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber p_dico = &dico4_lsf_5[temp]; 454a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 455a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *(lsf1_r + 6) = *p_dico++; 456a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *(lsf1_r + 7) = *p_dico++; 457a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *(lsf2_r + 6) = *p_dico++; 458a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *(lsf2_r + 7) = *p_dico++; 459a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 460a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber temp = 461a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber shl( 462a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *(indice + 4), 463a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 2, 464a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber pOverflow); 465a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 466a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber p_dico = &dico5_lsf_5[temp]; 467a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 468a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *(lsf1_r + 8) = *p_dico++; 469a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *(lsf1_r + 9) = *p_dico++; 470a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *(lsf2_r + 8) = *p_dico++; 471a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *(lsf2_r + 9) = *p_dico++; 472a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 473a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /* Compute quantized LSFs and update the past quantized 474a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber residual */ 475a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber for (i = 0; i < M; i++) 476a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 477a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber temp = 478a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber mult( 479a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber st->past_r_q[i], 480a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber LSP_PRED_FAC_MR122, 481a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber pOverflow); 482a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 483a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber temp = 484a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber add( 485a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *(mean_lsf_5 + i), 486a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber temp, 487a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber pOverflow); 488a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 489a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *(lsf1_q + i) = 490a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber add( 491a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *(lsf1_r + i), 492a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber temp, 493a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber pOverflow); 494a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 495a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *(lsf2_q + i) = 496a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber add( 497a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *(lsf2_r + i), 498a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber temp, 499a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber pOverflow); 500a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 501a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber st->past_r_q[i] = *(lsf2_r + i); 502a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 503a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 504a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 505a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /* verification that LSFs have minimum distance of LSF_GAP Hz */ 506a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 507a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Reorder_lsf( 508a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lsf1_q, 509a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber LSF_GAP, 510a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber M, 511a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber pOverflow); 512a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 513a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Reorder_lsf( 514a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lsf2_q, 515a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber LSF_GAP, 516a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber M, 517a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber pOverflow); 518a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 519a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Copy( 520a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lsf2_q, 521a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber st->past_lsf_q, 522a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber M); 523a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 524a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /* convert LSFs to the cosine domain */ 525a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 526a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Lsf_lsp( 527a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lsf1_q, 528a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lsp1_q, 529a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber M, 530a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber pOverflow); 531a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 532a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Lsf_lsp( 533a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lsf2_q, 534a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber lsp2_q, 535a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber M, 536a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber pOverflow); 537a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 538a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber return; 539a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber} 540