1b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/* ------------------------------------------------------------------ 2b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * Copyright (C) 1998-2009 PacketVideo 3b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * 4b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * Licensed under the Apache License, Version 2.0 (the "License"); 5b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * you may not use this file except in compliance with the License. 6b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * You may obtain a copy of the License at 7b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * 8b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * http://www.apache.org/licenses/LICENSE-2.0 9b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * 10b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * Unless required by applicable law or agreed to in writing, software 11b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * distributed under the License is distributed on an "AS IS" BASIS, 12b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either 13b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * express or implied. 14b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * See the License for the specific language governing permissions 15b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * and limitations under the License. 16b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * ------------------------------------------------------------------- 17b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber */ 18b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/**************************************************************************************** 19b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas HuberPortions of this file are derived from the following 3GPP standard: 20b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 21b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 3GPP TS 26.073 22b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ANSI-C code for the Adaptive Multi-Rate (AMR) speech codec 23b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Available from http://www.3gpp.org 24b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 25b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber(C) 2004, 3GPP Organizational Partners (ARIB, ATIS, CCSA, ETSI, TTA, TTC) 26b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas HuberPermission to distribute, modify and use this file under the standard license 27b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huberterms listed above has been obtained from the copyright holder. 28b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber****************************************************************************************/ 29b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/* 30b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 31b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 32b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 33b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 34b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Pathname: ./audio/gsm-amr/c/src/pitch_ol.c 35b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Funtions: Pitch_ol 36b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Lag_max 37b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 38b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 39b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber MODULE DESCRIPTION 40b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 41b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber The modules in this file compute the open loop pitch lag. 42b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 43b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber*/ 44b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 45b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 46b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 47b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; INCLUDES 48b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 49b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include <string.h> 50b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 51b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "pitch_ol.h" 52b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "typedef.h" 53b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "basicop_malloc.h" 54b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "cnst.h" 55b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "inv_sqrt.h" 56b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "vad.h" 57b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "calc_cor.h" 58b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "hp_max.h" 59b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "basic_op.h" 60b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 61b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 62b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; MACROS 63b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; Define module specific macros here 64b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 65b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 66b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 67b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 68b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; DEFINES 69b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; Include all pre-processor statements here. Include conditional 70b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; compile variables also. 71b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 72b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#define THRESHOLD 27853 73b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 74b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 75b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; LOCAL FUNCTION DEFINITIONS 76b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; Function Prototype declaration 77b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 78b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 79b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 80b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; LOCAL VARIABLE DEFINITIONS 81b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; Variable declaration - defined here and used outside this module 82b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 83b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 84b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 85b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/* 86b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 87b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION NAME: Lag_max 88b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 89b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber INPUT AND OUTPUT DEFINITIONS (If VAD2 is defined) 90b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 91b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Inputs 92b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber corr = pointer to buffer of correlation values (Word32) 93b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_sig = pointer to buffer of scaled signal values (Word16) 94b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_fac = scaled signal factor (Word16) 95b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_flag = EFR compatible scaling flag (Word16) 96b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_frame = length of frame to compute pitch (Word16) 97b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber lag_max = maximum lag (Word16) 98b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber lag_min = minimum lag (Word16) 99b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber cor_max = pointer to the normalized correlation of selected lag (Word16) 100b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber rmax = pointer to max(<s[i]*s[j]>), (Word32) 101b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber r0 = pointer to the residual energy (Word32) 102b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dtx = dtx flag; equal to 1, if dtx is enabled, 0, otherwise (Flag) 103b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 104b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Outputs: 105b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber cor_max contains the newly calculated normalized correlation of the 106b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber selected lag 107b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber rmax contains the newly calculated max(<s[i]*s[j]>) 108b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber r0 contains the newly calculated residual energy 109b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 110b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Returns: 111b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_max = lag of the max correlation found (Word16) 112b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 113b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Global Variables Used: 114b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None. 115b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 116b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Local Variables Needed: 117b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None. 118b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 119b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 120b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber INPUT AND OUTPUT DEFINITIONS (If VAD2 is not defined) 121b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 122b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Inputs 123b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber vadSt = pointer to a vadState structure 124b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber corr = pointer to buffer of correlation values (Word32) 125b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_sig = pointer to buffer of scaled signal values (Word16) 126b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_fac = scaled signal factor (Word16) 127b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_flag = EFR compatible scaling flag (Word16) 128b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_frame = length of frame to compute pitch (Word16) 129b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber lag_max = maximum lag (Word16) 130b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber lag_min = minimum lag (Word16) 131b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber cor_max = pointer to the normalized correlation of selected lag (Word16) 132b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dtx = dtx flag; equal to 1, if dtx is enabled, 0, otherwise (Flag) 133b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow = pointer to overflow indicator (Flag) 134b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 135b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Outputs: 136b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber cor_max contains the newly calculated normalized correlation of the 137b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber selected lag 138b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber vadSt contains the updated VAD state parameters 139b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow -> 1 if the math operations called by this routine saturate 140b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 141b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Returns: 142b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_max = lag of the max correlation found (Word16) 143b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 144b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Global Variables Used: 145b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None. 146b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 147b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Local Variables Needed: 148b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None. 149b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 150b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 151b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION DESCRIPTION 152b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 153b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Find the lag that has maximum correlation of scal_sig in a given delay range. 154b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber The correlation is given by: 155b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 156b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber cor[t] = <scal_sig[n],scal_sig[n-t]>, t=lag_min,...,lag_max 157b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 158b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber The function returns the maximum correlation after normalization and the 159b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber corresponding lag. 160b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 161b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 162b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REQUIREMENTS 163b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 164b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None. 165b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 166b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 167b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REFERENCES 168b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 169b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pitch_ol.c, UMTS GSM AMR speech codec, R99 - Version 3.2.0, March 2, 2001 170b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 171b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 172b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber PSEUDO-CODE 173b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 174b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#ifdef VAD2 175b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huberstatic Word16 Lag_max ( // o : lag found 176b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 corr[], // i : correlation vector. 177b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 scal_sig[], // i : scaled signal. 178b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 scal_fac, // i : scaled signal factor. 179b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 scal_flag, // i : if 1 use EFR compatible scaling 180b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 L_frame, // i : length of frame to compute pitch 181b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 lag_max, // i : maximum lag 182b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 lag_min, // i : minimum lag 183b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *cor_max, // o : normalized correlation of selected lag 184b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 *rmax, // o : max(<s[i]*s[j]>) 185b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 *r0, // o : residual energy 186b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Flag dtx // i : dtx flag; use dtx=1, do not use dtx=0 187b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ) 188b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#else 189b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huberstatic Word16 Lag_max ( // o : lag found 190b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber vadState *vadSt, // i/o : VAD state struct 191b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 corr[], // i : correlation vector. 192b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 scal_sig[], // i : scaled signal. 193b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 scal_fac, // i : scaled signal factor. 194b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 scal_flag, // i : if 1 use EFR compatible scaling 195b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 L_frame, // i : length of frame to compute pitch 196b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 lag_max, // i : maximum lag 197b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 lag_min, // i : minimum lag 198b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *cor_max, // o : normalized correlation of selected lag 199b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Flag dtx // i : dtx flag; use dtx=1, do not use dtx=0 200b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ) 201b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#endif 202b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 203b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 i, j; 204b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *p; 205b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 max, t0; 206b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 max_h, max_l, ener_h, ener_l; 207b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 p_max = 0; // initialization only needed to keep gcc silent 208b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 209b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber max = MIN_32; 210b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_max = lag_max; 211b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 212b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = lag_max, j = (PIT_MAX-lag_max-1); i >= lag_min; i--, j--) 213b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 214b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (L_sub (corr[-i], max) >= 0) 215b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 216b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber max = corr[-i]; 217b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_max = i; 218b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 219b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 220b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 221b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // compute energy 222b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 223b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = 0; 224b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p = &scal_sig[-p_max]; 225b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 0; i < L_frame; i++, p++) 226b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 227b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = L_mac (t0, *p, *p); 228b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 229b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // 1/sqrt(energy) 230b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 231b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (dtx) 232b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { // no test() call since this if is only in simulation env 233b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#ifdef VAD2 234b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *rmax = max; 235b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *r0 = t0; 236b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#else 237b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // check tone 238b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber vad_tone_detection (vadSt, max, t0); 239b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#endif 240b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 241b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 242b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = Inv_sqrt (t0); 243b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 244b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (scal_flag) 245b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 246b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = L_shl (t0, 1); 247b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 248b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 249b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // max = max/sqrt(energy) 250b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 251b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_Extract (max, &max_h, &max_l); 252b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_Extract (t0, &ener_h, &ener_l); 253b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 254b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = Mpy_32 (max_h, max_l, ener_h, ener_l); 255b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 256b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (scal_flag) 257b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 258b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = L_shr (t0, scal_fac); 259b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *cor_max = extract_h (L_shl (t0, 15)); // divide by 2 260b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 261b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 262b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 263b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *cor_max = extract_l(t0); 264b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 265b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 266b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return (p_max); 267b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 268b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 269b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 270b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber RESOURCES USED [optional] 271b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 272b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber When the code is written for a specific target processor the 273b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber the resources used should be documented below. 274b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 275b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber HEAP MEMORY USED: x bytes 276b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 277b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber STACK MEMORY USED: x bytes 278b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 279b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CLOCK CYCLES: (cycle count equation for this function) + (variable 280b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber used to represent cycle count for each subroutine 281b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber called) 282b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber where: (cycle count variable) = cycle count for [subroutine 283b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber name] 284b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 285b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 286b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CAUTION [optional] 287b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber [State any special notes, constraints or cautions for users of this function] 288b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 289b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 290b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber*/ 291b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 292b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#ifdef VAD2 293b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huberstatic Word16 Lag_max( /* o : lag found */ 294b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 corr[], /* i : correlation vector. */ 295b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 scal_sig[], /* i : scaled signal. */ 296b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 scal_fac, /* i : scaled signal factor. */ 297b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 scal_flag, /* i : if 1 use EFR compatible scaling */ 298b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 L_frame, /* i : length of frame to compute pitch */ 299b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 lag_max, /* i : maximum lag */ 300b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 lag_min, /* i : minimum lag */ 301b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *cor_max, /* o : normalized correlation of selected lag */ 302b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 *rmax, /* o : max(<s[i]*s[j]>) */ 303b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 *r0, /* o : residual energy */ 304b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Flag dtx, /* i : dtx flag; use dtx=1, do not use dtx=0 */ 305b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Flag *pOverflow /* i/o : overflow Flag */ 306b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber) 307b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#else 308b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huberstatic Word16 Lag_max( /* o : lag found */ 309b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber vadState *vadSt, /* i/o : VAD state struct */ 310b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 corr[], /* i : correlation vector. */ 311b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 scal_sig[], /* i : scaled signal. */ 312b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 scal_fac, /* i : scaled signal factor. */ 313b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 scal_flag, /* i : if 1 use EFR compatible scaling */ 314b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 L_frame, /* i : length of frame to compute pitch */ 315b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 lag_max, /* i : maximum lag */ 316b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 lag_min, /* i : minimum lag */ 317b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *cor_max, /* o : normalized correlation of selected lag */ 318b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Flag dtx, /* i : dtx flag; use dtx=1, do not use dtx=0 */ 319b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Flag *pOverflow /* i/o : overflow Flag */ 320b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber) 321b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#endif 322b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 3232d0ac425564ff9882ebaac5267d1a04d4af67d00Bernhard Rosenkränzer Word16 i; 324b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *p; 325b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 max; 326b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 t0; 327b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 max_h; 328b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 max_l; 329b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 ener_h; 330b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 ener_l; 331b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 p_max = 0; /* initialization only needed to keep gcc silent */ 332b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 L_temp; 333b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 L_temp_2; 334b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 L_temp_3; 335b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 *p_corr = &corr[-lag_max]; 336b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 337b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber max = MIN_32; 338b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_max = lag_max; 339b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 340b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = lag_max; i >= lag_min; i--) 341b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 342b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* The negative array index is equivalent to a negative */ 343b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* address offset, i.e., corr[-i] == *(corr - i) */ 344b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (*(p_corr++) >= max) 345b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 346b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_corr--; 347b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber max = *(p_corr++); 348b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_max = i; 349b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 350b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 351b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 352b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* compute energy */ 353b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 354b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = 0; 355b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 356b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* The negative array index is equivalent to a negative */ 357b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* address offset, i.e., scal_sig[-p_max] == *(scal_sig - p_max) */ 358b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p = &scal_sig[-p_max]; 359b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = (L_frame >> 2); i != 0; i--) 360b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 361b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = amrnb_fxp_mac_16_by_16bb((Word32) * (p), (Word32) * (p), t0); 362b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p++; 363b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = amrnb_fxp_mac_16_by_16bb((Word32) * (p), (Word32) * (p), t0); 364b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p++; 365b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = amrnb_fxp_mac_16_by_16bb((Word32) * (p), (Word32) * (p), t0); 366b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p++; 367b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = amrnb_fxp_mac_16_by_16bb((Word32) * (p), (Word32) * (p), t0); 368b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p++; 369b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 370b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 371b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 <<= 1; 372b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* 1/sqrt(energy) */ 373b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 374b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (dtx) 375b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { /* no test() call since this if is only in simulation env */ 376b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* check tone */ 377b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#ifdef VAD2 378b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *rmax = max; 379b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *r0 = t0; 380b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#else 381b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* check tone */ 382b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber vad_tone_detection(vadSt, max, t0, pOverflow); 383b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#endif 384b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 385b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 386b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = Inv_sqrt(t0, pOverflow); 387b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 388b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (scal_flag) 389b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 390b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (t0 > (Word32) 0x3fffffffL) 391b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 392b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = MAX_32; 393b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 394b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 395b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 396b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = t0 << 1; 397b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 398b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 399b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 400b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* max = max/sqrt(energy) */ 401b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* The following code is an inlined version of */ 402b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* L_Extract (max, &max_h, &max_l), i.e. */ 403b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* */ 404b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* *max_h = extract_h (max); */ 405b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber max_h = (Word16)(max >> 16); 406b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 407b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* L_temp_2 = L_shr(max,1), which is used in */ 408b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* the calculation of *max_l (see next operation) */ 409b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_temp_2 = max >> 1; 410b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 411b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* *max_l = extract_l (L_msu (L_shr (max, 1), *max_h, 16384)); */ 412b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_temp_3 = (Word32)(max_h << 15); 413b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 414b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_temp = L_temp_2 - L_temp_3; 415b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 416b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber max_l = (Word16)L_temp; 417b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 418b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* The following code is an inlined version of */ 419b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* L_Extract (t0, &ener_h, &ener_l), i.e. */ 420b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* */ 421b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* *ener_h = extract_h (t0); */ 422b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ener_h = (Word16)(t0 >> 16); 423b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 424b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* L_temp_2 = L_shr(t0,1), which is used in */ 425b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* the calculation of *ener_l (see next operation) */ 426b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 427b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_temp_2 = t0 >> 1; 428b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 429b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_temp_3 = (Word32)(ener_h << 15); 430b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 431b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_temp = L_temp_2 - L_temp_3; 432b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 433b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ener_l = (Word16)L_temp; 434b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 435b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = Mpy_32(max_h, max_l, ener_h, ener_l, pOverflow); 436b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 437b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (scal_flag) 438b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 439b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = L_shr(t0, scal_fac, pOverflow); 440b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 441b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (t0 > (Word32) 0X0000FFFFL) 442b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 443b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *cor_max = MAX_16; 444b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 445b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else if (t0 < (Word32) 0xFFFF0000L) 446b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 447b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *cor_max = MIN_16; 448b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 449b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 450b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 451b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *cor_max = (Word16)(t0 >> 1); 452b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 453b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 454b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 455b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 456b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *cor_max = (Word16)t0; 457b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 458b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 459b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return (p_max); 460b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 461b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 462b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 463b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; End Function: Lag_max 464b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 465b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 466b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 467b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/* 468b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 469b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION NAME: Lag_max_wrapper 470b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 471b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber INPUT AND OUTPUT DEFINITIONS 472b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 473b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Inputs 474b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber corr = pointer to buffer of correlation values (Word32) 475b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_sig = pointer to buffer of scaled signal values (Word16) 476b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_fac = scaled signal factor (Word16) 477b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_flag = EFR compatible scaling flag (Word16) 478b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_frame = length of frame to compute pitch (Word16) 479b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber lag_max = maximum lag (Word16) 480b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber lag_min = minimum lag (Word16) 481b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber cor_max = pointer to the normalized correlation of selected lag (Word16) 482b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber rmax = pointer to max(<s[i]*s[j]>), (Word32) 483b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber r0 = pointer to the residual energy (Word32) 484b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dtx = dtx flag; equal to 1, if dtx is enabled, 0, otherwise (Flag) 485b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow = pointer to overflow indicator (Flag) 486b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 487b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Outputs: 488b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber cor_max contains the newly calculated normalized correlation of the 489b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber selected lag 490b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber rmax contains the newly calculated max(<s[i]*s[j]>) 491b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber r0 contains the newly calculated residual energy 492b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow -> 1 if the math operations called by this routine saturate 493b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 494b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Returns: 495b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_max = lag of the max correlation found (Word16) 496b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 497b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Global Variables Used: 498b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None. 499b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 500b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Local Variables Needed: 501b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None. 502b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 503b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 504b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber INPUT AND OUTPUT DEFINITIONS (If VAD2 is not defined) 505b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 506b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Inputs 507b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber vadSt = pointer to a vadState structure 508b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber corr = pointer to buffer of correlation values (Word32) 509b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_sig = pointer to buffer of scaled signal values (Word16) 510b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_fac = scaled signal factor (Word16) 511b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_flag = EFR compatible scaling flag (Word16) 512b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_frame = length of frame to compute pitch (Word16) 513b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber lag_max = maximum lag (Word16) 514b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber lag_min = minimum lag (Word16) 515b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber cor_max = pointer to the normalized correlation of selected lag (Word16) 516b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dtx = dtx flag; equal to 1, if dtx is enabled, 0, otherwise (Flag) 517b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow = pointer to overflow indicator (Flag) 518b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 519b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Outputs: 520b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber cor_max contains the newly calculated normalized correlation of the 521b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber selected lag 522b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber vadSt contains the updated VAD state parameters 523b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow -> 1 if the math operations called by this routine saturate 524b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 525b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Returns: 526b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_max = lag of the max correlation found (Word16) 527b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 528b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Global Variables Used: 529b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None. 530b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 531b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Local Variables Needed: 532b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None. 533b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 534b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 535b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION DESCRIPTION 536b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 537b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber This function provides external access to the local function Lag_max. 538b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 539b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 540b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REQUIREMENTS 541b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 542b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 543b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 544b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 545b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REFERENCES 546b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 547b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pitch_ol.c, UMTS GSM AMR speech codec, R99 - Version 3.2.0, March 2, 2001 548b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 549b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 550b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber PSEUDO-CODE 551b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 552b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#ifdef VAD2 553b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CALL Lag_max(corr = corr 554b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_sig = scal_sig 555b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_fac = scal_fac 556b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_flag = scal_flag 557b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_frame = L_frame 558b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber lag_max = lag_max 559b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber lag_min = lag_min 560b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber cor_max = cor_max 561b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber rmax = rmax 562b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber r0 = r0 563b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dtx = dtx 564b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow = pOverflow) 565b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber MODIFYING(nothing) 566b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber RETURNING(temp) 567b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 568b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#else 569b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CALL Lag_max(vadSt = vadSt 570b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber corr = corr 571b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_sig = scal_sig 572b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_fac = scal_fac 573b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_flag = scal_flag 574b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_frame = L_frame 575b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber lag_max = lag_max 576b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber lag_min = lag_min 577b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber cor_max = cor_max 578b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dtx = dtx 579b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow = pOverflow) 580b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber MODIFYING(nothing) 581b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber RETURNING(temp) 582b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 583b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#endif 584b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 585b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 586b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber RESOURCES USED [optional] 587b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 588b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber When the code is written for a specific target processor the 589b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber the resources used should be documented below. 590b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 591b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber HEAP MEMORY USED: x bytes 592b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 593b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber STACK MEMORY USED: x bytes 594b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 595b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CLOCK CYCLES: (cycle count equation for this function) + (variable 596b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber used to represent cycle count for each subroutine 597b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber called) 598b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber where: (cycle count variable) = cycle count for [subroutine 599b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber name] 600b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 601b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 602b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CAUTION [optional] 603b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber [State any special notes, constraints or cautions for users of this function] 604b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 605b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 606b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber*/ 607b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 608b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#ifdef VAD2 609b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas HuberWord16 Lag_max_wrapper( /* o : lag found */ 610b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 corr[], /* i : correlation vector. */ 611b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 scal_sig[], /* i : scaled signal. */ 612b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 scal_fac, /* i : scaled signal factor. */ 613b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 scal_flag, /* i : if 1 use EFR compatible scaling */ 614b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 L_frame, /* i : length of frame to compute pitch */ 615b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 lag_max, /* i : maximum lag */ 616b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 lag_min, /* i : minimum lag */ 617b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *cor_max, /* o : normalized correlation of selected lag */ 618b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 *rmax, /* o : max(<s[i]*s[j]>) */ 619b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 *r0, /* o : residual energy */ 620b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Flag dtx, /* i : dtx flag; use dtx=1, do not use dtx=0 */ 621b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Flag *pOverflow /* i/o : overflow Flag */ 622b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber) 623b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 624b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 temp; 625b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 626b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber temp = Lag_max(corr, scal_sig, scal_fac, scal_flag, L_frame, lag_max, 627b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber lag_min, cor_max, rmax, r0, dtx, pOverflow); 628b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 629b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return(temp); 630b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 631b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 632b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#else 633b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas HuberWord16 Lag_max_wrapper( /* o : lag found */ 634b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber vadState *vadSt, /* i/o : VAD state struct */ 635b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 corr[], /* i : correlation vector. */ 636b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 scal_sig[], /* i : scaled signal. */ 637b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 scal_fac, /* i : scaled signal factor. */ 638b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 scal_flag, /* i : if 1 use EFR compatible scaling */ 639b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 L_frame, /* i : length of frame to compute pitch */ 640b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 lag_max, /* i : maximum lag */ 641b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 lag_min, /* i : minimum lag */ 642b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *cor_max, /* o : normalized correlation of selected lag */ 643b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Flag dtx, /* i : dtx flag; use dtx=1, do not use dtx=0 */ 644b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Flag *pOverflow /* i/o : overflow Flag */ 645b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber) 646b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 647b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 temp; 648b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 649b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber temp = Lag_max(vadSt, corr, scal_sig, scal_fac, scal_flag, L_frame, 650b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber lag_max, lag_min, cor_max, dtx, pOverflow); 651b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 652b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return(temp); 653b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 654b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 655b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#endif 656b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 657b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 658b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; End Function: Lag_max_wrapper 659b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 660b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 661b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/* 662b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 663b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION NAME: Pitch_ol 664b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 665b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber INPUT AND OUTPUT DEFINITIONS 666b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 667b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Inputs: 668b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber vadSt = pointer to a vadState structure 669b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber mode = data of type enum Mode specifies the mode. 670b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber signal = pointer to buffer of signal used to compute the open loop 671b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pitch 672b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber where signal[-pit_max] to signal[-1] should be known 673b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pit_min = 16 bit value specifies the minimum pitch lag 674b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pit_max = 16 bit value specifies the maximum pitch lag 675b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_frame = 16 bit value specifies the length of frame to compute pitch 676b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber idx = 16 bit value specifies the frame index 677b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dtx = Data of type 'Flag' used for dtx. Use dtx=1, do not use dtx=0 678b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow = pointer to overflow indicator (Flag) 679b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 680b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Outputs 681b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber vadSt = The vadSt state structure may be modified. 682b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow -> 1 if the math operations called by this routine saturate 683b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 684b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Returns: 685b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_max1 = 16 bit value representing the open loop pitch lag. 686b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 687b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Global Variables Used: 688b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None. 689b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 690b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Local Variables Needed: 691b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None. 692b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 693b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 694b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION DESCRIPTION 695b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 696b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber This function computes the open loop pitch lag based on the perceptually 697b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber weighted speech signal. This is done in the following steps: 698b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber - find three maxima of the correlation <sw[n],sw[n-T]>, 699b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dividing the search range into three parts: 700b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pit_min ... 2*pit_min-1 701b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 2*pit_min ... 4*pit_min-1 702b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 4*pit_min ... pit_max 703b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber - divide each maximum by <sw[n-t], sw[n-t]> where t is the delay at 704b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber that maximum correlation. 705b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber - select the delay of maximum normalized correlation (among the 706b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber three candidates) while favoring the lower delay ranges. 707b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 708b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 709b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 710b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REQUIREMENTS 711b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 712b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None. 713b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 714b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 715b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REFERENCES 716b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 717b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pitch_ol.c, UMTS GSM AMR speech codec, R99 - Version 3.2.0, March 2, 2001 718b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 719b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 720b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber PSEUDO-CODE 721b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 722b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas HuberWord16 Pitch_ol ( // o : open loop pitch lag 723b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber vadState *vadSt, // i/o : VAD state struct 724b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber enum Mode mode, // i : coder mode 725b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 signal[], // i : signal used to compute the open loop pitch 726b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // signal[-pit_max] to signal[-1] should be known 727b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 pit_min, // i : minimum pitch lag 728b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 pit_max, // i : maximum pitch lag 729b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 L_frame, // i : length of frame to compute pitch 730b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 idx, // i : frame index 731b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Flag dtx // i : dtx flag; use dtx=1, do not use dtx=0 732b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ) 733b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 734b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 i, j; 735b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 max1, max2, max3; 736b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 p_max1, p_max2, p_max3; 737b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 scal_flag = 0; 738b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 t0; 739b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#ifdef VAD2 740b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 r01, r02, r03; 741b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 rmax1, rmax2, rmax3; 742b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#else 743b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 corr_hp_max; 744b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#endif 745b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 corr[PIT_MAX+1], *corr_ptr; 746b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 747b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // Scaled signal 748b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 749b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 scaled_signal[L_FRAME + PIT_MAX]; 750b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *scal_sig, scal_fac; 751b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 752b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#ifndef VAD2 753b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (dtx) 754b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { // no test() call since this if is only in simulation env 755b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // update tone detection 756b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if ((sub(mode, MR475) == 0) || (sub(mode, MR515) == 0)) 757b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 758b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber vad_tone_detection_update (vadSt, 1); 759b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 760b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 761b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 762b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber vad_tone_detection_update (vadSt, 0); 763b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 764b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 765b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#endif 766b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 767b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_sig = &scaled_signal[pit_max]; 768b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 769b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = 0L; 770b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = -pit_max; i < L_frame; i++) 771b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 772b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = L_mac (t0, signal[i], signal[i]); 773b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 774b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 775b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *--------------------------------------------------------* 776b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * Scaling of input signal. * 777b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * * 778b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * if Overflow -> scal_sig[i] = signal[i]>>3 * 779b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * else if t0 < 1^20 -> scal_sig[i] = signal[i]<<3 * 780b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * else -> scal_sig[i] = signal[i] * 781b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *--------------------------------------------------------* 782b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 783b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *--------------------------------------------------------* 784b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * Verification for risk of overflow. * 785b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *--------------------------------------------------------* 786b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 787b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (L_sub (t0, MAX_32) == 0L) // Test for overflow 788b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 789b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = -pit_max; i < L_frame; i++) 790b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 791b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_sig[i] = shr (signal[i], 3); 792b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 793b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_fac = 3; 794b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 795b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else if (L_sub (t0, (Word32) 1048576L) < (Word32) 0) 796b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // if (t0 < 2^20) 797b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 798b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = -pit_max; i < L_frame; i++) 799b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 800b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_sig[i] = shl (signal[i], 3); 801b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 802b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_fac = -3; 803b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 804b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 805b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 806b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = -pit_max; i < L_frame; i++) 807b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 808b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_sig[i] = signal[i]; 809b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 810b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_fac = 0; 811b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 812b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 813b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // calculate all coreelations of scal_sig, from pit_min to pit_max 814b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber corr_ptr = &corr[pit_max]; 815b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber comp_corr (scal_sig, L_frame, pit_max, pit_min, corr_ptr); 816b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 817b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *--------------------------------------------------------------------* 818b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * The pitch lag search is divided in three sections. * 819b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * Each section cannot have a pitch multiple. * 820b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * We find a maximum for each section. * 821b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * We compare the maximum of each section by favoring small lags. * 822b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * * 823b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * First section: lag delay = pit_max downto 4*pit_min * 824b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * Second section: lag delay = 4*pit_min-1 downto 2*pit_min * 825b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * Third section: lag delay = 2*pit_min-1 downto pit_min * 826b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *--------------------------------------------------------------------* 827b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 828b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // mode dependent scaling in Lag_max 829b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (sub(mode, MR122) == 0) 830b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 831b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_flag = 1; 832b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 833b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 834b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 835b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_flag = 0; 836b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 837b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 838b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#ifdef VAD2 839b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber j = shl (pit_min, 2); 840b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_max1 = Lag_max (corr_ptr, scal_sig, scal_fac, scal_flag, L_frame, 841b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pit_max, j, &max1, &rmax1, &r01, dtx); 842b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 843b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber i = sub (j, 1); 844b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber j = shl (pit_min, 1); 845b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_max2 = Lag_max (corr_ptr, scal_sig, scal_fac, scal_flag, L_frame, 846b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber i, j, &max2, &rmax2, &r02, dtx); 847b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 848b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber i = sub (j, 1); 849b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_max3 = Lag_max (corr_ptr, scal_sig, scal_fac, scal_flag, L_frame, 850b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber i, pit_min, &max3, &rmax3, &r03, dtx); 851b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#else 852b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber j = shl (pit_min, 2); 853b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_max1 = Lag_max (vadSt, corr_ptr, scal_sig, scal_fac, scal_flag, L_frame, 854b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pit_max, j, &max1, dtx); 855b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 856b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber i = sub (j, 1); 857b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber j = shl (pit_min, 1); 858b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_max2 = Lag_max (vadSt, corr_ptr, scal_sig, scal_fac, scal_flag, L_frame, 859b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber i, j, &max2, dtx); 860b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 861b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber i = sub (j, 1); 862b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_max3 = Lag_max (vadSt, corr_ptr, scal_sig, scal_fac, scal_flag, L_frame, 863b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber i, pit_min, &max3, dtx); 864b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 865b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (dtx) 866b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { // no test() call since this if is only in simulation env 867b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (sub(idx, 1) == 0) 868b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 869b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // calculate max high-passed filtered correlation of all lags 870b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber hp_max (corr_ptr, scal_sig, L_frame, pit_max, pit_min, &corr_hp_max); 871b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 872b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // update complex background detector 873b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber vad_complex_detection_update(vadSt, corr_hp_max); 874b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 875b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 876b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#endif 877b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 878b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *--------------------------------------------------------------------* 879b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * Compare the 3 sections maximum, and favor small lag. * 880b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *--------------------------------------------------------------------* 881b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 882b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (sub (mult (max1, THRESHOLD), max2) < 0) 883b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 884b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber max1 = max2; 885b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_max1 = p_max2; 886b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#ifdef VAD2 887b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (dtx) 888b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 889b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber rmax1 = rmax2; 890b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber r01 = r02; 891b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#endif 892b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 893b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (sub (mult (max1, THRESHOLD), max3) < 0) 894b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 895b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_max1 = p_max3; 896b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#ifdef VAD2 897b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (dtx) 898b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 899b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber rmax1 = rmax3; 900b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber r01 = r03; 901b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 902b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#endif 903b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 904b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 905b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#ifdef VAD2 906b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (dtx) 907b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 908b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber vadSt->L_Rmax = L_add(vadSt->L_Rmax, rmax1); // Save max correlation 909b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber vadSt->L_R0 = L_add(vadSt->L_R0, r01); // Save max energy 910b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 911b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#endif 912b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 913b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return (p_max1); 914b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 915b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 916b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 917b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber RESOURCES USED [optional] 918b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 919b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber When the code is written for a specific target processor the 920b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber the resources used should be documented below. 921b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 922b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber HEAP MEMORY USED: x bytes 923b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 924b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber STACK MEMORY USED: x bytes 925b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 926b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CLOCK CYCLES: (cycle count equation for this function) + (variable 927b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber used to represent cycle count for each subroutine 928b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber called) 929b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber where: (cycle count variable) = cycle count for [subroutine 930b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber name] 931b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 932b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 933b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CAUTION [optional] 934b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber [State any special notes, constraints or cautions for users of this function] 935b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 936b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 937b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber*/ 938b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 939b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas HuberWord16 Pitch_ol( /* o : open loop pitch lag */ 940b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber vadState *vadSt, /* i/o : VAD state struct */ 941b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber enum Mode mode, /* i : coder mode */ 942b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 signal[], /* i : signal used to compute the open loop pitch */ 943b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* signal[-pit_max] to signal[-1] should be known */ 944b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 pit_min, /* i : minimum pitch lag */ 945b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 pit_max, /* i : maximum pitch lag */ 946b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 L_frame, /* i : length of frame to compute pitch */ 947b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 idx, /* i : frame index */ 948b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Flag dtx, /* i : dtx flag; use dtx=1, do not use dtx=0 */ 949b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Flag *pOverflow /* i/o : overflow Flag */ 950b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber) 951b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 952b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 i; 953b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 j; 954b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 max1; 955b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 max2; 956b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 max3; 957b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 p_max1; 958b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 p_max2; 959b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 p_max3; 960b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 scal_flag = 0; 961b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 t0; 962b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 963b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#ifdef VAD2 964b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 r01; 965b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 r02; 966b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 r03; 967b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 rmax1; 968b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 rmax2; 969b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 rmax3; 970b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#else 971b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 corr_hp_max; 972b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#endif 973b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 corr[PIT_MAX+1]; 974b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 *corr_ptr; 975b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 976b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* Scaled signal */ 977b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 978b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 scaled_signal[L_FRAME + PIT_MAX]; 979b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *scal_sig; 980b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *p_signal; 981b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 scal_fac; 982b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 L_temp; 983b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 984b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#ifndef VAD2 985b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (dtx) 986b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { /* no test() call since this if is only in simulation env */ 987b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* update tone detection */ 988b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if ((mode == MR475) || (mode == MR515)) 989b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 990b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber vad_tone_detection_update(vadSt, 1, pOverflow); 991b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 992b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 993b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 994b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber vad_tone_detection_update(vadSt, 0, pOverflow); 995b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 996b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 997b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#endif 998b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 999b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1000b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = 0L; 1001b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_signal = &signal[-pit_max]; 1002b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1003b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = -pit_max; i < L_frame; i++) 1004b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 1005b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 += (((Word32) * (p_signal)) * *(p_signal)) << 1; 1006b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_signal++; 1007b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (t0 < 0) 1008b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 1009b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = MAX_32; 1010b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber break; 1011b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1012b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1013b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1014b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1015b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /*--------------------------------------------------------* 1016b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * Scaling of input signal. * 1017b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * * 1018b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * if Overflow -> scal_sig[i] = signal[i]>>3 * 1019b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * else if t0 < 1^20 -> scal_sig[i] = signal[i]<<3 * 1020b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * else -> scal_sig[i] = signal[i] * 1021b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *--------------------------------------------------------*/ 1022b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1023b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /*--------------------------------------------------------* 1024b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * Verification for risk of overflow. * 1025b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *--------------------------------------------------------*/ 1026b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1027b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_sig = &scaled_signal[0]; 1028b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_signal = &signal[-pit_max]; 1029b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1030b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (t0 == MAX_32) /* Test for overflow */ 1031b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 1032b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1033b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = (pit_max + L_frame) >> 1; i != 0; i--) 1034b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 1035b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *(scal_sig++) = (Word16)(((Word32) * (p_signal++) >> 3)); 1036b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *(scal_sig++) = (Word16)(((Word32) * (p_signal++) >> 3)); 1037b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1038b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1039b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if ((pit_max + L_frame) & 1) 1040b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 1041b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *(scal_sig) = (Word16)(((Word32) * (p_signal) >> 3)); 1042b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1043b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1044b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_fac = 3; 1045b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1046b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else if (t0 < (Word32)1048576L) 1047b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* if (t0 < 2^20) */ 1048b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 1049b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = (pit_max + L_frame) >> 1; i != 0; i--) 1050b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 1051b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *(scal_sig++) = (Word16)(((Word32) * (p_signal++) << 3)); 1052b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *(scal_sig++) = (Word16)(((Word32) * (p_signal++) << 3)); 1053b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1054b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1055b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if ((pit_max + L_frame) & 1) 1056b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 1057b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *(scal_sig) = (Word16)(((Word32) * (p_signal) << 3)); 1058b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1059b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_fac = -3; 1060b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1061b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 1062b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 1063b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1064b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber memcpy(scal_sig, p_signal, (L_frame + pit_max)*sizeof(*signal)); 1065b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_fac = 0; 1066b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1067b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1068b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* calculate all coreelations of scal_sig, from pit_min to pit_max */ 1069b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber corr_ptr = &corr[pit_max]; 1070b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1071b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_sig = &scaled_signal[pit_max]; 1072b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1073b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber comp_corr(scal_sig, L_frame, pit_max, pit_min, corr_ptr); 1074b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1075b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /*--------------------------------------------------------------------* 1076b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * The pitch lag search is divided in three sections. * 1077b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * Each section cannot have a pitch multiple. * 1078b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * We find a maximum for each section. * 1079b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * We compare the maximum of each section by favoring small lags. * 1080b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * * 1081b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * First section: lag delay = pit_max downto 4*pit_min * 1082b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * Second section: lag delay = 4*pit_min-1 downto 2*pit_min * 1083b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * Third section: lag delay = 2*pit_min-1 downto pit_min * 1084b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *--------------------------------------------------------------------*/ 1085b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1086b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* mode dependent scaling in Lag_max */ 1087b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1088b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (mode == MR122) 1089b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 1090b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_flag = 1; 1091b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1092b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 1093b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 1094b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_flag = 0; 1095b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1096b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1097b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#ifdef VAD2 1098b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_temp = ((Word32)pit_min) << 2; 1099b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (L_temp != (Word32)((Word16) L_temp)) 1100b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 1101b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *pOverflow = 1; 1102b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber j = (pit_min > 0) ? MAX_16 : MIN_16; 1103b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1104b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 1105b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 1106b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber j = (Word16)L_temp; 1107b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1108b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1109b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_max1 = Lag_max(corr_ptr, scal_sig, scal_fac, scal_flag, L_frame, 1110b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pit_max, j, &max1, &rmax1, &r01, dtx, pOverflow); 1111b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1112b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber i = j - 1; 1113b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1114b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber j = pit_min << 1; 1115b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1116b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_max2 = Lag_max(corr_ptr, scal_sig, scal_fac, scal_flag, L_frame, 1117b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber i, j, &max2, &rmax2, &r02, dtx, pOverflow); 1118b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1119b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber i = j - 1; 1120b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1121b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_max3 = Lag_max(corr_ptr, scal_sig, scal_fac, scal_flag, L_frame, 1122b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber i, pit_min, &max3, &rmax3, &r03, dtx, pOverflow); 1123b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1124b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#else 1125b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_temp = ((Word32)pit_min) << 2; 1126b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (L_temp != (Word32)((Word16) L_temp)) 1127b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 1128b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *pOverflow = 1; 1129b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber j = (pit_min > 0) ? MAX_16 : MIN_16; 1130b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1131b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 1132b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 1133b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber j = (Word16)L_temp; 1134b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1135b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1136b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_max1 = Lag_max(vadSt, corr_ptr, scal_sig, scal_fac, scal_flag, L_frame, 1137b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pit_max, j, &max1, dtx, pOverflow); 1138b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1139b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber i = j - 1; 1140b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1141b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1142b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber j = pit_min << 1; 1143b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1144b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1145b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_max2 = Lag_max(vadSt, corr_ptr, scal_sig, scal_fac, scal_flag, L_frame, 1146b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber i, j, &max2, dtx, pOverflow); 1147b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1148b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber i = j - 1; 1149b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_max3 = Lag_max(vadSt, corr_ptr, scal_sig, scal_fac, scal_flag, L_frame, 1150b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber i, pit_min, &max3, dtx, pOverflow); 1151b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1152b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (dtx) 1153b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { /* no test() call since this if is only in simulation env */ 1154b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1155b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (idx == 1) 1156b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 1157b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* calculate max high-passed filtered correlation of all lags */ 1158b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber hp_max(corr_ptr, scal_sig, L_frame, pit_max, pit_min, &corr_hp_max, 1159b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow); 1160b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1161b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* update complex background detector */ 1162b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber vad_complex_detection_update(vadSt, corr_hp_max); 1163b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1164b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1165b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#endif 1166b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1167b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /*--------------------------------------------------------------------* 1168b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * Compare the 3 sections maximum, and favor small lag. * 1169b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *--------------------------------------------------------------------*/ 1170b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1171b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber i = mult(max1, THRESHOLD, pOverflow); 1172b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1173b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (i < max2) 1174b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 1175b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber max1 = max2; 1176b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_max1 = p_max2; 1177b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1178b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#ifdef VAD2 1179b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (dtx) 1180b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 1181b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber rmax1 = rmax2; 1182b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber r01 = r02; 1183b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1184b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#endif 1185b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1186b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1187b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber i = mult(max1, THRESHOLD, pOverflow); 1188b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1189b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (i < max3) 1190b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 1191b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_max1 = p_max3; 1192b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1193b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#ifdef VAD2 1194b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (dtx) 1195b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 1196b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber rmax1 = rmax3; 1197b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber r01 = r03; 1198b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1199b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#endif 1200b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1201b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1202b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#ifdef VAD2 1203b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (dtx) 1204b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 1205b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* Save max correlation */ 1206b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber vadSt->L_Rmax = L_add(vadSt->L_Rmax, rmax1, pOverflow); 1207b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* Save max energy */ 1208b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber vadSt->L_R0 = L_add(vadSt->L_R0, r01, pOverflow); 1209b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1210b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#endif 1211b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1212b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return (p_max1); 1213b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 1214