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_fr.c 35b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Functions: 36b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 37b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 38b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Date: 02/04/2002 39b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 40b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 41b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REVISION HISTORY 42b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 43b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Added pOverflow as a passed in value to searchFrac and made 44b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber other fixes to the code regarding simple syntax fixes. Removed 45b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber the include of stio.h. 46b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 47b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: *lag-- decrements the pointer. (*lag)-- decrements what is 48b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pointed to. The latter is what the coder intended, but the former is 49b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber the coding instruction that was used. 50b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 51b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: A common problem -- a comparison != 0 was inadvertantly replaced 52b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber by a comparison == 0. 53b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 54b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 55b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: For Norm_Corr() and getRange() 56b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1. Eliminated unused include files. 57b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 2. Replaced array addressing by pointers 58b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 3. Eliminated math operations that unnecessary checked for 59b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber saturation, in some cases this by shifting before adding and 60b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber in other cases by evaluating the operands 61b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 4. Unrolled loops to speed up processing, use decrement loops 62b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 5. Replaced extract_l() call with equivalent code 63b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 6. Modified scaling threshold and group all shifts (avoiding 64b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber successive shifts) 65b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 66b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Replaced OSCL mem type functions and eliminated include 67b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber files that now are chosen by OSCL definitions 68b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 69b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Replaced "int" and/or "char" with OSCL defined types. 70b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 71b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Removed compiler warnings. 72b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 73b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: 74b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 75b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber MODULE DESCRIPTION 76b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 77b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber File : pitch_fr.c 78b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Purpose : Find the pitch period with 1/3 or 1/6 subsample 79b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber : resolution (closed loop). 80b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 81b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 82b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber*/ 83b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 84b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 85b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; INCLUDES 86b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 87b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include <stdlib.h> 88b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 89b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "pitch_fr.h" 90b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "oper_32b.h" 91b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "cnst.h" 92b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "enc_lag3.h" 93b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "enc_lag6.h" 94b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "inter_36.h" 95b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "inv_sqrt.h" 96b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "convolve.h" 97b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 98b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "basic_op.h" 99b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 100b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 101b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 102b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; MACROS 103b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; Define module specific macros here 104b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 105b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 106b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 107b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; DEFINES 108b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; Include all pre-processor statements here. Include conditional 109b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; compile variables also. 110b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 111b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 112b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 113b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; LOCAL FUNCTION DEFINITIONS 114b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; Function Prototype declaration 115b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 116b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 117b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 118b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; LOCAL VARIABLE DEFINITIONS 119b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; Variable declaration - defined here and used outside this module 120b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 121b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 122b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/* 123b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * mode dependent parameters used in Pitch_fr() 124b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * Note: order of MRxx in 'enum Mode' is important! 125b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber */ 126b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huberstatic const struct 127b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 128b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 max_frac_lag; /* lag up to which fractional lags are used */ 129b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 flag3; /* enable 1/3 instead of 1/6 fract. resolution */ 130b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 first_frac; /* first fractional to check */ 131b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 last_frac; /* last fractional to check */ 132b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 delta_int_low; /* integer lag below TO to start search from */ 133b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 delta_int_range; /* integer range around T0 */ 134b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 delta_frc_low; /* fractional below T0 */ 135b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 delta_frc_range; /* fractional range around T0 */ 136b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 pit_min; /* minimum pitch */ 137b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} mode_dep_parm[N_MODES] = 138b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 139b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* MR475 */ { 84, 1, -2, 2, 5, 10, 5, 9, PIT_MIN }, 140b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* MR515 */ { 84, 1, -2, 2, 5, 10, 5, 9, PIT_MIN }, 141b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* MR59 */ { 84, 1, -2, 2, 3, 6, 5, 9, PIT_MIN }, 142b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* MR67 */ { 84, 1, -2, 2, 3, 6, 5, 9, PIT_MIN }, 143b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* MR74 */ { 84, 1, -2, 2, 3, 6, 5, 9, PIT_MIN }, 144b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* MR795 */ { 84, 1, -2, 2, 3, 6, 10, 19, PIT_MIN }, 145b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* MR102 */ { 84, 1, -2, 2, 3, 6, 5, 9, PIT_MIN }, 146b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* MR122 */ { 94, 0, -3, 3, 3, 6, 5, 9, PIT_MIN_MR122 } 147b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber}; 148b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 149b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/* 150b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 151b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION NAME: Norm_Corr 152b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 153b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber INPUT AND OUTPUT DEFINITIONS 154b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 155b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Inputs: 156b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exc[] = pointer to buffer of type Word16 157b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber xn[] = pointer to buffer of type Word16 158b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber h[] = pointer to buffer of type Word16 159b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_subfr = length of sub frame (Word16) 160b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t_min = the minimum table value of type Word16 161b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t_max = the maximum table value of type Word16 162b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber corr_norm[] = pointer to buffer of type Word16 163b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 164b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Outputs: 165b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow = 1 if the math functions called result in overflow else zero. 166b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 167b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Returns: 168b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 169b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 170b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Global Variables Used: 171b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 172b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 173b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Local Variables Needed: 174b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 175b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 176b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 177b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION DESCRIPTION 178b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 179b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION: Norm_Corr() 180b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 181b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber PURPOSE: Find the normalized correlation between the target vector 182b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber and the filtered past excitation. 183b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 184b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber DESCRIPTION: 185b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber The normalized correlation is given by the correlation between the 186b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber target and filtered past excitation divided by the square root of 187b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber the energy of filtered excitation. 188b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber corr[k] = <x[], y_k[]>/sqrt(y_k[],y_k[]) 189b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber where x[] is the target vector and y_k[] is the filtered past 190b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber excitation at delay k. 191b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 192b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 193b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 194b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REQUIREMENTS 195b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 196b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 197b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 198b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 199b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REFERENCES 200b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 201b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pitch_fr.c, UMTS GSM AMR speech codec, R99 - Version 3.2.0, March 2, 2001 202b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 203b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 204b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber PSEUDO-CODE 205b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 206b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huberstatic void Norm_Corr (Word16 exc[], Word16 xn[], Word16 h[], Word16 L_subfr, 207b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 t_min, Word16 t_max, Word16 corr_norm[]) 208b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 209b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 i, j, k; 210b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 corr_h, corr_l, norm_h, norm_l; 211b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 s; 212b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 213b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // Usally dynamic allocation of (L_subfr) 214b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 excf[L_SUBFR]; 215b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 scaling, h_fac, *s_excf, scaled_excf[L_SUBFR]; 216b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 217b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber k = -t_min; 218b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 219b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // compute the filtered excitation for the first delay t_min 220b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 221b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Convolve (&exc[k], h, excf, L_subfr); 222b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 223b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // scale "excf[]" to avoid overflow 224b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 225b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (j = 0; j < L_subfr; j++) { 226b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scaled_excf[j] = shr (excf[j], 2); 227b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 228b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 229b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // Compute 1/sqrt(energy of excf[]) 230b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 231b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = 0; 232b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (j = 0; j < L_subfr; j++) { 233b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = L_mac (s, excf[j], excf[j]); 234b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 235b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (L_sub (s, 67108864L) <= 0) { // if (s <= 2^26) 236b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s_excf = excf; 237b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber h_fac = 15 - 12; 238b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scaling = 0; 239b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 240b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else { 241b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // "excf[]" is divided by 2 242b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s_excf = scaled_excf; 243b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber h_fac = 15 - 12 - 2; 244b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scaling = 2; 245b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 246b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 247b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // loop for every possible period 248b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 249b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = t_min; i <= t_max; i++) { 250b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // Compute 1/sqrt(energy of excf[]) 251b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 252b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = 0; 253b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (j = 0; j < L_subfr; j++) { 254b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = L_mac (s, s_excf[j], s_excf[j]); 255b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 256b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 257b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = Inv_sqrt (s); 258b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_Extract (s, &norm_h, &norm_l); 259b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 260b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // Compute correlation between xn[] and excf[] 261b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 262b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = 0; 263b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (j = 0; j < L_subfr; j++) { 264b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = L_mac (s, xn[j], s_excf[j]); 265b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 266b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_Extract (s, &corr_h, &corr_l); 267b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 268b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // Normalize correlation = correlation * (1/sqrt(energy)) 269b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 270b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = Mpy_32 (corr_h, corr_l, norm_h, norm_l); 271b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 272b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber corr_norm[i] = extract_h (L_shl (s, 16)); 273b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 274b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // modify the filtered excitation excf[] for the next iteration 275b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 276b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (sub (i, t_max) != 0) { 277b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber k--; 278b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (j = L_subfr - 1; j > 0; j--) { 279b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = L_mult (exc[k], h[j]); 280b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = L_shl (s, h_fac); 281b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s_excf[j] = add (extract_h (s), s_excf[j - 1]); 282b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 283b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s_excf[0] = shr (exc[k], scaling); 284b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 285b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 286b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return; 287b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 288b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 289b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 290b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber RESOURCES USED [optional] 291b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 292b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber When the code is written for a specific target processor the 293b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber the resources used should be documented below. 294b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 295b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber HEAP MEMORY USED: x bytes 296b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 297b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber STACK MEMORY USED: x bytes 298b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 299b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CLOCK CYCLES: (cycle count equation for this function) + (variable 300b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber used to represent cycle count for each subroutine 301b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber called) 302b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber where: (cycle count variable) = cycle count for [subroutine 303b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber name] 304b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 305b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 306b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CAUTION [optional] 307b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber [State any special notes, constraints or cautions for users of this function] 308b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 309b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 310b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber*/ 311b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 312b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huberstatic void Norm_Corr(Word16 exc[], 313b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 xn[], 314b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 h[], 315b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 L_subfr, 316b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 t_min, 317b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 t_max, 318b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 corr_norm[], 319b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Flag *pOverflow) 320b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 321b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 i; 322b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 j; 323b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 k; 324b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 corr_h; 325b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 corr_l; 326b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 norm_h; 327b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 norm_l; 328b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 s; 329b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 s2; 330b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 excf[L_SUBFR]; 331b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 scaling; 332b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 h_fac; 333b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *s_excf; 334b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 scaled_excf[L_SUBFR]; 335b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *p_s_excf; 336b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *p_excf; 337b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 temp; 338b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *p_x; 339b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *p_h; 340b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 341b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber k = -t_min; 342b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 343b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* compute the filtered excitation for the first delay t_min */ 344b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 345b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Convolve(&exc[k], h, excf, L_subfr); 346b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 347b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* scale "excf[]" to avoid overflow */ 348b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = 0; 349b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_s_excf = scaled_excf; 350b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_excf = excf; 351b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 352b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (j = (L_subfr >> 1); j != 0; j--) 353b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 354b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber temp = *(p_excf++); 355b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *(p_s_excf++) = temp >> 2; 356b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s += (Word32) temp * temp; 357b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber temp = *(p_excf++); 358b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *(p_s_excf++) = temp >> 2; 359b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s += (Word32) temp * temp; 360b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 361b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 362b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 363b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (s <= (67108864L >> 1)) 364b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 365b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s_excf = excf; 366b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber h_fac = 12; 367b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scaling = 0; 368b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 369b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 370b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 371b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* "excf[]" is divided by 2 */ 372b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s_excf = scaled_excf; 373b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber h_fac = 14; 374b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scaling = 2; 375b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 376b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 377b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* loop for every possible period */ 378b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 379b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = t_min; i <= t_max; i++) 380b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 381b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* Compute 1/sqrt(energy of excf[]) */ 382b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 383b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = s2 = 0; 384b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_x = xn; 385b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_s_excf = s_excf; 386b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber j = L_subfr >> 1; 387b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 388b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber while (j--) 389b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 390b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s += (Word32) * (p_x++) * *(p_s_excf); 391b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s2 += ((Word32)(*(p_s_excf)) * (*(p_s_excf))); 392b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_s_excf++; 393b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s += (Word32) * (p_x++) * *(p_s_excf); 394b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s2 += ((Word32)(*(p_s_excf)) * (*(p_s_excf))); 395b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_s_excf++; 396b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 397b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 398b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s2 = s2 << 1; 399b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s2 = Inv_sqrt(s2, pOverflow); 400b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber norm_h = (Word16)(s2 >> 16); 401b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber norm_l = (Word16)((s2 >> 1) - (norm_h << 15)); 402b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber corr_h = (Word16)(s >> 15); 403b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber corr_l = (Word16)((s) - (corr_h << 15)); 404b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 405b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* Normalize correlation = correlation * (1/sqrt(energy)) */ 406b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 407b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = Mpy_32(corr_h, corr_l, norm_h, norm_l, pOverflow); 408b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 409b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber corr_norm[i] = (Word16) s ; 410b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 411b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* modify the filtered excitation excf[] for the next iteration */ 412b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (i != t_max) 413b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 414b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber k--; 415b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber temp = exc[k]; 416b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_s_excf = &s_excf[L_subfr - 1]; 417b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_h = &h[L_subfr - 1]; 418b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 419b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_excf = &s_excf[L_subfr - 2]; 420b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (j = (L_subfr - 1) >> 1; j != 0; j--) 421b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 422b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = ((Word32) temp * *(p_h--)) >> h_fac; 423b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *(p_s_excf--) = (Word16) s + *(p_excf--); 424b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = ((Word32) temp * *(p_h--)) >> h_fac; 425b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *(p_s_excf--) = (Word16) s + *(p_excf--); 426b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 427b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 428b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = ((Word32) temp * *(p_h)) >> h_fac; 429b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *(p_s_excf--) = (Word16) s + *(p_excf); 430b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 431b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *(p_s_excf) = temp >> scaling; 432b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 433b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 434b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 435b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return; 436b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 437b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 438b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/****************************************************************************/ 439b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 440b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 441b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/* 442b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 443b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION NAME: searchFrac 444b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 445b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber INPUT AND OUTPUT DEFINITIONS 446b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 447b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Inputs: 448b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber lag = pointer to integer pitch of type Word16 449b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac = pointer to starting point of search fractional pitch of type Word16 450b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber last_frac = endpoint of search of type Word16 451b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber corr[] = pointer to normalized correlation of type Word16 452b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber flag3 = subsample resolution (3: =1 / 6: =0) of type Word16 453b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 454b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Outputs: 455b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 456b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 457b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Returns: 458b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 459b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 460b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Global Variables Used: 461b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 462b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 463b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Local Variables Needed: 464b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 465b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 466b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 467b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION DESCRIPTION 468b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 469b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION: searchFrac() 470b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 471b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber PURPOSE: Find fractional pitch 472b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 473b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber DESCRIPTION: 474b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber The function interpolates the normalized correlation at the 475b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber fractional positions around lag T0. The position at which the 476b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber interpolation function reaches its maximum is the fractional pitch. 477b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Starting point of the search is frac, end point is last_frac. 478b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac is overwritten with the fractional pitch. 479b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 480b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 481b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REQUIREMENTS 482b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 483b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 484b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 485b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 486b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REFERENCES 487b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 488b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pitch_fr.c, UMTS GSM AMR speech codec, R99 - Version 3.2.0, March 2, 2001 489b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 490b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 491b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber PSEUDO-CODE 492b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 493b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huberstatic void searchFrac ( 494b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *lag, // i/o : integer pitch 495b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *frac, // i/o : start point of search - 496b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber fractional pitch 497b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 last_frac, // i : endpoint of search 498b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 corr[], // i : normalized correlation 499b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 flag3 // i : subsample resolution 500b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber (3: =1 / 6: =0) 501b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber) 502b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 503b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 i; 504b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 max; 505b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 corr_int; 506b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 507b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // Test the fractions around T0 and choose the one which maximizes 508b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // the interpolated normalized correlation. 509b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 510b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber max = Interpol_3or6 (&corr[*lag], *frac, flag3); // function result 511b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 512b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = add (*frac, 1); i <= last_frac; i++) { 513b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber corr_int = Interpol_3or6 (&corr[*lag], i, flag3); 514b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (sub (corr_int, max) > 0) { 515b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber max = corr_int; 516b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *frac = i; 517b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 518b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 519b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 520b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (flag3 == 0) { 521b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // Limit the fraction value in the interval [-2,-1,0,1,2,3] 522b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 523b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (sub (*frac, -3) == 0) { 524b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *frac = 3; 525b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *lag = sub (*lag, 1); 526b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 527b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 528b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else { 529b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // limit the fraction value between -1 and 1 530b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 531b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (sub (*frac, -2) == 0) { 532b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *frac = 1; 533b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *lag = sub (*lag, 1); 534b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 535b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (sub (*frac, 2) == 0) { 536b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *frac = -1; 537b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *lag = add (*lag, 1); 538b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 539b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 540b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 541b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 542b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 543b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber RESOURCES USED [optional] 544b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 545b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber When the code is written for a specific target processor the 546b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber the resources used should be documented below. 547b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 548b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber HEAP MEMORY USED: x bytes 549b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 550b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber STACK MEMORY USED: x bytes 551b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 552b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CLOCK CYCLES: (cycle count equation for this function) + (variable 553b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber used to represent cycle count for each subroutine 554b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber called) 555b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber where: (cycle count variable) = cycle count for [subroutine 556b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber name] 557b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 558b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 559b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CAUTION [optional] 560b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber [State any special notes, constraints or cautions for users of this function] 561b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 562b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 563b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber*/ 564b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 565b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huberstatic void searchFrac( 566b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *lag, /* i/o : integer pitch */ 567b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *frac, /* i/o : start point of search - 568b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber fractional pitch */ 569b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 last_frac, /* i : endpoint of search */ 570b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 corr[], /* i : normalized correlation */ 571b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 flag3, /* i : subsample resolution 572b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber (3: =1 / 6: =0) */ 573b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Flag *pOverflow 574b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber) 575b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 576b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 i; 577b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 max; 578b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 corr_int; 579b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 580b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* Test the fractions around T0 and choose the one which maximizes */ 581b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* the interpolated normalized correlation. */ 582b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 583b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber max = Interpol_3or6(&corr[*lag], *frac, flag3, pOverflow); 584b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* function result */ 585b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 586b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = *frac + 1; i <= last_frac; i++) 587b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 588b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber corr_int = Interpol_3or6(&corr[*lag], i, flag3, pOverflow); 589b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (corr_int > max) 590b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 591b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber max = corr_int; 592b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *frac = i; 593b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 594b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 595b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 596b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (flag3 == 0) 597b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 598b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* Limit the fraction value in the interval [-2,-1,0,1,2,3] */ 599b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 600b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (*frac == -3) 601b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 602b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *frac = 3; 603b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber (*lag)--; 604b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 605b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 606b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 607b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 608b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* limit the fraction value between -1 and 1 */ 609b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 610b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (*frac == -2) 611b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 612b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *frac = 1; 613b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber (*lag)--; 614b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 615b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (*frac == 2) 616b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 617b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *frac = -1; 618b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber (*lag)++; 619b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 620b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 621b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 622b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 623b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/****************************************************************************/ 624b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 625b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 626b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/* 627b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 628b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION NAME: getRange 629b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 630b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber INPUT AND OUTPUT DEFINITIONS 631b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 632b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Inputs: 633b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber T0 = integer pitch of type Word16 634b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber delta_low = search start offset of type Word16 635b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber delta_range = search range of type Word16 636b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pitmin = minimum pitch of type Word16 637b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pitmax = maximum pitch of type Word16 638b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0_min = search range minimum of type Word16 639b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0_max = search range maximum of type Word16 640b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 641b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Outputs: 642b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow = 1 if the math functions called result in overflow else zero. 643b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 644b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Returns: 645b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 646b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 647b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Global Variables Used: 648b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 649b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 650b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Local Variables Needed: 651b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 652b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 653b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 654b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION DESCRIPTION 655b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 656b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION: getRange() 657b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 658b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber PURPOSE: Sets range around open-loop pitch or integer pitch of last subframe 659b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 660b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber DESCRIPTION: 661b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Takes integer pitch T0 and calculates a range around it with 662b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0_min = T0-delta_low and t0_max = (T0-delta_low) + delta_range 663b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0_min and t0_max are bounded by pitmin and pitmax 664b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 665b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REQUIREMENTS 666b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 667b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 668b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 669b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 670b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REFERENCES 671b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 672b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pitch_fr.c, UMTS GSM AMR speech codec, R99 - Version 3.2.0, March 2, 2001 673b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 674b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 675b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber PSEUDO-CODE 676b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 677b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huberstatic void getRange ( 678b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 T0, // i : integer pitch 679b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 delta_low, // i : search start offset 680b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 delta_range, // i : search range 681b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 pitmin, // i : minimum pitch 682b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 pitmax, // i : maximum pitch 683b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *t0_min, // o : search range minimum 684b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *t0_max) // o : search range maximum 685b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 686b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *t0_min = sub(T0, delta_low); 687b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (sub(*t0_min, pitmin) < 0) { 688b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *t0_min = pitmin; 689b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 690b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *t0_max = add(*t0_min, delta_range); 691b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (sub(*t0_max, pitmax) > 0) { 692b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *t0_max = pitmax; 693b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *t0_min = sub(*t0_max, delta_range); 694b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 695b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 696b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 697b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 698b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber RESOURCES USED [optional] 699b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 700b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber When the code is written for a specific target processor the 701b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber the resources used should be documented below. 702b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 703b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber HEAP MEMORY USED: x bytes 704b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 705b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber STACK MEMORY USED: x bytes 706b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 707b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CLOCK CYCLES: (cycle count equation for this function) + (variable 708b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber used to represent cycle count for each subroutine 709b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber called) 710b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber where: (cycle count variable) = cycle count for [subroutine 711b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber name] 712b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 713b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 714b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CAUTION [optional] 715b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber [State any special notes, constraints or cautions for users of this function] 716b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 717b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 718b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber*/ 719b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huberstatic void getRange( 720b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 T0, /* i : integer pitch */ 721b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 delta_low, /* i : search start offset */ 722b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 delta_range, /* i : search range */ 723b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 pitmin, /* i : minimum pitch */ 724b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 pitmax, /* i : maximum pitch */ 725b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *t0_min, /* o : search range minimum */ 726b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *t0_max, /* o : search range maximum */ 727b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Flag *pOverflow) 728b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 729b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 730b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 temp; 731b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber OSCL_UNUSED_ARG(pOverflow); 732b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 733b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber temp = *t0_min; 734b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber temp = T0 - delta_low; 735b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (temp < pitmin) 736b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 737b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber temp = pitmin; 738b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 739b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *t0_min = temp; 740b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 741b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber temp += delta_range; 742b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (temp > pitmax) 743b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 744b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber temp = pitmax; 745b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *t0_min = pitmax - delta_range; 746b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 747b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *t0_max = temp; 748b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 749b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 750b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 751b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 752b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/****************************************************************************/ 753b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 754b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 755b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/* 756b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 757b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION NAME: Pitch_fr_init 758b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 759b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber INPUT AND OUTPUT DEFINITIONS 760b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 761b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Inputs: 762b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber state = pointer to a pointer of structure type Pitch_fr_State. 763b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 764b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Outputs: 765b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 766b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 767b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Returns: 768b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Returns a zero if successful and -1 if not successful. 769b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 770b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Global Variables Used: 771b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 772b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 773b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Local Variables Needed: 774b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 775b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 776b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 777b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION DESCRIPTION 778b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 779b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Function: Pitch_fr_init 780b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Purpose: Allocates state memory and initializes state memory 781b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 782b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 783b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REQUIREMENTS 784b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 785b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 786b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 787b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 788b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REFERENCES 789b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 790b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pitch_fr.c, UMTS GSM AMR speech codec, R99 - Version 3.2.0, March 2, 2001 791b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 792b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 793b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber PSEUDO-CODE 794b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 795b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huberint Pitch_fr_init (Pitch_frState **state) 796b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 797b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Pitch_frState* s; 798b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 799b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (state == (Pitch_frState **) NULL){ 800b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // fprintf(stderr, "Pitch_fr_init: invalid parameter\n"); 801b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return -1; 802b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 803b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *state = NULL; 804b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 805b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // allocate memory 806b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if ((s= (Pitch_frState *) malloc(sizeof(Pitch_frState))) == NULL){ 807b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // fprintf(stderr, "Pitch_fr_init: can not malloc state structure\n"); 808b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return -1; 809b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 810b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 811b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Pitch_fr_reset(s); 812b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *state = s; 813b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 814b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return 0; 815b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 816b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 817b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 818b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber RESOURCES USED [optional] 819b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 820b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber When the code is written for a specific target processor the 821b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber the resources used should be documented below. 822b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 823b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber HEAP MEMORY USED: x bytes 824b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 825b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber STACK MEMORY USED: x bytes 826b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 827b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CLOCK CYCLES: (cycle count equation for this function) + (variable 828b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber used to represent cycle count for each subroutine 829b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber called) 830b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber where: (cycle count variable) = cycle count for [subroutine 831b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber name] 832b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 833b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 834b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CAUTION [optional] 835b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber [State any special notes, constraints or cautions for users of this function] 836b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 837b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 838b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber*/ 839b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas HuberWord16 Pitch_fr_init(Pitch_frState **state) 840b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 841b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Pitch_frState* s; 842b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 843b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (state == (Pitch_frState **) NULL) 844b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 845b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* fprintf(stderr, "Pitch_fr_init: invalid parameter\n"); */ 846b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return -1; 847b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 848b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *state = NULL; 849b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 850b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* allocate memory */ 851b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if ((s = (Pitch_frState *) malloc(sizeof(Pitch_frState))) == NULL) 852b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 853b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* fprintf(stderr, "Pitch_fr_init: can not malloc state structure\n"); */ 854b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return -1; 855b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 856b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 857b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Pitch_fr_reset(s); 858b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *state = s; 859b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 860b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return 0; 861b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 862b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 863b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 864b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/****************************************************************************/ 865b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 866b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 867b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/* 868b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 869b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION NAME: Pitch_fr_reset 870b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 871b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber INPUT AND OUTPUT DEFINITIONS 872b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 873b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Inputs: 874b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber state = pointer to a pointer of structure type Pitch_fr_State. 875b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 876b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Outputs: 877b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 878b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 879b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Returns: 880b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Returns a zero if successful and -1 if not successful. 881b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 882b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Global Variables Used: 883b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 884b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 885b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Local Variables Needed: 886b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 887b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 888b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 889b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION DESCRIPTION 890b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 891b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Function: Pitch_fr_reset 892b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Purpose: Initializes state memory to zero 893b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 894b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 895b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REQUIREMENTS 896b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 897b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 898b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 899b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 900b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REFERENCES 901b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 902b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pitch_fr.c, UMTS GSM AMR speech codec, R99 - Version 3.2.0, March 2, 2001 903b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 904b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 905b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber PSEUDO-CODE 906b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 907b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huberint Pitch_fr_reset (Pitch_frState *state) 908b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 909b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 910b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (state == (Pitch_frState *) NULL){ 911b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // fprintf(stderr, "Pitch_fr_reset: invalid parameter\n"); 912b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return -1; 913b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 914b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 915b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber state->T0_prev_subframe = 0; 916b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 917b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return 0; 918b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 919b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 920b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 921b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber RESOURCES USED [optional] 922b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 923b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber When the code is written for a specific target processor the 924b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber the resources used should be documented below. 925b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 926b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber HEAP MEMORY USED: x bytes 927b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 928b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber STACK MEMORY USED: x bytes 929b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 930b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CLOCK CYCLES: (cycle count equation for this function) + (variable 931b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber used to represent cycle count for each subroutine 932b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber called) 933b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber where: (cycle count variable) = cycle count for [subroutine 934b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber name] 935b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 936b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 937b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CAUTION [optional] 938b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber [State any special notes, constraints or cautions for users of this function] 939b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 940b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 941b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber*/ 942b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas HuberWord16 Pitch_fr_reset(Pitch_frState *state) 943b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 944b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 945b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (state == (Pitch_frState *) NULL) 946b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 947b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* fprintf(stderr, "Pitch_fr_reset: invalid parameter\n"); */ 948b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return -1; 949b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 950b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 951b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber state->T0_prev_subframe = 0; 952b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 953b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return 0; 954b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 955b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 956b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 957b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/****************************************************************************/ 958b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 959b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 960b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/* 961b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 962b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION NAME: Pitch_fr_exit 963b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 964b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber INPUT AND OUTPUT DEFINITIONS 965b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 966b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Inputs: 967b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber state = pointer to a pointer of structure type Pitch_fr_State. 968b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 969b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Outputs: 970b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 971b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 972b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Returns: 973b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 974b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 975b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Global Variables Used: 976b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 977b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 978b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Local Variables Needed: 979b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 980b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 981b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 982b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION DESCRIPTION 983b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 984b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Function: Pitch_fr_exit 985b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Purpose: The memory for state is freed. 986b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 987b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 988b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REQUIREMENTS 989b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 990b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 991b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 992b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 993b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REFERENCES 994b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 995b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pitch_fr.c, UMTS GSM AMR speech codec, R99 - Version 3.2.0, March 2, 2001 996b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 997b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 998b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber PSEUDO-CODE 999b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1000b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Hubervoid Pitch_fr_exit (Pitch_frState **state) 1001b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 1002b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (state == NULL || *state == NULL) 1003b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return; 1004b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1005b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // deallocate memory 1006b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber free(*state); 1007b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *state = NULL; 1008b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1009b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return; 1010b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 1011b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1012b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 1013b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber RESOURCES USED [optional] 1014b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1015b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber When the code is written for a specific target processor the 1016b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber the resources used should be documented below. 1017b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1018b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber HEAP MEMORY USED: x bytes 1019b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1020b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber STACK MEMORY USED: x bytes 1021b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1022b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CLOCK CYCLES: (cycle count equation for this function) + (variable 1023b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber used to represent cycle count for each subroutine 1024b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber called) 1025b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber where: (cycle count variable) = cycle count for [subroutine 1026b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber name] 1027b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1028b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 1029b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CAUTION [optional] 1030b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber [State any special notes, constraints or cautions for users of this function] 1031b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1032b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 1033b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber*/ 1034b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Hubervoid Pitch_fr_exit(Pitch_frState **state) 1035b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 1036b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (state == NULL || *state == NULL) 1037b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return; 1038b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1039b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* deallocate memory */ 1040b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber free(*state); 1041b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *state = NULL; 1042b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1043b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return; 1044b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 1045b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1046b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/****************************************************************************/ 1047b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1048b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1049b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/* 1050b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 1051b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION NAME: Pitch_fr 1052b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 1053b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber INPUT AND OUTPUT DEFINITIONS 1054b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1055b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Inputs: 1056b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber st = pointer to stat structure of type Pitch_frState 1057b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber mode = codec mode of type enum Mode 1058b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber T_op[] = pointer to open loop pitch lags of type Word16 1059b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber exc[] = pointer to excitation buffer of type Word16 1060b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber xn[] = pointer to target vector of type Word16 1061b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber h[] = pointer to impulse response of synthesis and weighting filters 1062b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber of type Word16 1063b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_subfr = length of subframe of type Word16 1064b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber i_subfr = subframe offset of type Word16 1065b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1066b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Outputs: 1067b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pit_frac = pointer to pitch period (fractional) of type Word16 1068b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber resu3 = pointer to subsample resolution of type Word16 1069b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ana_index = pointer to index of encoding of type Word16 1070b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1071b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Returns: 1072b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 1073b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1074b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Global Variables Used: 1075b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 1076b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1077b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Local Variables Needed: 1078b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 1079b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1080b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 1081b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION DESCRIPTION 1082b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1083b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION: Pitch_fr() 1084b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1085b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber PURPOSE: Find the pitch period with 1/3 or 1/6 subsample resolution 1086b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber (closed loop). 1087b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1088b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber DESCRIPTION: 1089b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber - find the normalized correlation between the target and filtered 1090b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber past excitation in the search range. 1091b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber - select the delay with maximum normalized correlation. 1092b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber - interpolate the normalized correlation at fractions -3/6 to 3/6 1093b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber with step 1/6 around the chosen delay. 1094b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber - The fraction which gives the maximum interpolated value is chosen. 1095b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1096b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 1097b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REQUIREMENTS 1098b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1099b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 1100b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1101b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 1102b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REFERENCES 1103b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1104b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pitch_fr.c, UMTS GSM AMR speech codec, R99 - Version 3.2.0, March 2, 2001 1105b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1106b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 1107b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber PSEUDO-CODE 1108b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1109b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas HuberWord16 Pitch_fr ( // o : pitch period (integer) 1110b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Pitch_frState *st, // i/o : State struct 1111b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber enum Mode mode, // i : codec mode 1112b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 T_op[], // i : open loop pitch lags 1113b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 exc[], // i : excitation buffer Q0 1114b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 xn[], // i : target vector Q0 1115b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 h[], // i : impulse response of synthesis and 1116b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber weighting filters Q12 1117b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 L_subfr, // i : Length of subframe 1118b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 i_subfr, // i : subframe offset 1119b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *pit_frac, // o : pitch period (fractional) 1120b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *resu3, // o : subsample resolution 1/3 (=1) or 1/6 (=0) 1121b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *ana_index // o : index of encoding 1122b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber) 1123b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 1124b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 i; 1125b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 t_min, t_max; 1126b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 t0_min, t0_max; 1127b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 max, lag, frac; 1128b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 tmp_lag; 1129b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *corr; 1130b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 corr_v[40]; // Total length = t0_max-t0_min+1+2*L_INTER_SRCH 1131b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1132b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 max_frac_lag; 1133b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 flag3, flag4; 1134b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 last_frac; 1135b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 delta_int_low, delta_int_range; 1136b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 delta_frc_low, delta_frc_range; 1137b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 pit_min; 1138b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 frame_offset; 1139b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 delta_search; 1140b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1141b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber //----------------------------------------------------------------------- 1142b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // set mode specific variables 1143b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber //---------------------------------------------------------------------- 1144b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1145b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber max_frac_lag = mode_dep_parm[mode].max_frac_lag; 1146b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber flag3 = mode_dep_parm[mode].flag3; 1147b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac = mode_dep_parm[mode].first_frac; 1148b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber last_frac = mode_dep_parm[mode].last_frac; 1149b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber delta_int_low = mode_dep_parm[mode].delta_int_low; 1150b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber delta_int_range = mode_dep_parm[mode].delta_int_range; 1151b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1152b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber delta_frc_low = mode_dep_parm[mode].delta_frc_low; 1153b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber delta_frc_range = mode_dep_parm[mode].delta_frc_range; 1154b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pit_min = mode_dep_parm[mode].pit_min; 1155b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1156b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber //----------------------------------------------------------------------- 1157b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // decide upon full or differential search 1158b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber //----------------------------------------------------------------------- 1159b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1160b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber delta_search = 1; 1161b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1162b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if ((i_subfr == 0) || (sub(i_subfr,L_FRAME_BY2) == 0)) { 1163b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1164b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // Subframe 1 and 3 1165b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1166b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (((sub((Word16)mode, (Word16)MR475) != 0) && (sub((Word16)mode, 1167b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber (Word16)MR515) != 0)) || 1168b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber (sub(i_subfr,L_FRAME_BY2) != 0)) { 1169b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1170b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // set t0_min, t0_max for full search 1171b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // this is *not* done for mode MR475, MR515 in subframe 3 1172b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1173b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber delta_search = 0; // no differential search 1174b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1175b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // calculate index into T_op which contains the open-loop 1176b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // pitch estimations for the 2 big subframes 1177b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1178b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frame_offset = 1; 1179b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (i_subfr == 0) 1180b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frame_offset = 0; 1181b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1182b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // get T_op from the corresponding half frame and 1183b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // set t0_min, t0_max 1184b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1185b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber getRange (T_op[frame_offset], delta_int_low, delta_int_range, 1186b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pit_min, PIT_MAX, &t0_min, &t0_max); 1187b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1188b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else { 1189b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1190b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // mode MR475, MR515 and 3. Subframe: delta search as well 1191b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber getRange (st->T0_prev_subframe, delta_frc_low, delta_frc_range, 1192b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pit_min, PIT_MAX, &t0_min, &t0_max); 1193b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1194b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1195b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else { 1196b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1197b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // for Subframe 2 and 4 1198b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // get range around T0 of previous subframe for delta search 1199b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1200b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber getRange (st->T0_prev_subframe, delta_frc_low, delta_frc_range, 1201b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pit_min, PIT_MAX, &t0_min, &t0_max); 1202b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1203b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1204b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber //----------------------------------------------------------------------- 1205b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Find interval to compute normalized correlation 1206b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ----------------------------------------------------------------------- 1207b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1208b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t_min = sub (t0_min, L_INTER_SRCH); 1209b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t_max = add (t0_max, L_INTER_SRCH); 1210b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1211b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber corr = &corr_v[-t_min]; 1212b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1213b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber //----------------------------------------------------------------------- 1214b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Compute normalized correlation between target and filtered excitation 1215b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ----------------------------------------------------------------------- 1216b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1217b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Norm_Corr (exc, xn, h, L_subfr, t_min, t_max, corr); 1218b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1219b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber //----------------------------------------------------------------------- 1220b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Find integer pitch 1221b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ----------------------------------------------------------------------- 1222b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1223b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber max = corr[t0_min]; 1224b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber lag = t0_min; 1225b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1226b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = t0_min + 1; i <= t0_max; i++) { 1227b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (sub (corr[i], max) >= 0) { 1228b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber max = corr[i]; 1229b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber lag = i; 1230b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1231b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1232b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1233b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber //----------------------------------------------------------------------- 1234b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Find fractional pitch 1235b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ----------------------------------------------------------------------- 1236b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if ((delta_search == 0) && (sub (lag, max_frac_lag) > 0)) { 1237b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1238b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // full search and integer pitch greater than max_frac_lag 1239b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // fractional search is not needed, set fractional to zero 1240b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1241b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac = 0; 1242b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1243b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else { 1244b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1245b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // if differential search AND mode MR475 OR MR515 OR MR59 OR MR67 1246b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // then search fractional with 4 bits resolution 1247b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1248b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if ((delta_search != 0) && 1249b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ((sub ((Word16)mode, (Word16)MR475) == 0) || 1250b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber (sub ((Word16)mode, (Word16)MR515) == 0) || 1251b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber (sub ((Word16)mode, (Word16)MR59) == 0) || 1252b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber (sub ((Word16)mode, (Word16)MR67) == 0))) { 1253b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1254b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // modify frac or last_frac according to position of last 1255b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // integer pitch: either search around integer pitch, 1256b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // or only on left or right side 1257b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1258b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tmp_lag = st->T0_prev_subframe; 1259b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if ( sub( sub(tmp_lag, t0_min), 5) > 0) 1260b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tmp_lag = add (t0_min, 5); 1261b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if ( sub( sub(t0_max, tmp_lag), 4) > 0) 1262b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tmp_lag = sub (t0_max, 4); 1263b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1264b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if ((sub (lag, tmp_lag) == 0) || 1265b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber (sub (lag, sub(tmp_lag, 1)) == 0)) { 1266b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1267b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // normal search in fractions around T0 1268b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1269b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber searchFrac (&lag, &frac, last_frac, corr, flag3); 1270b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1271b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1272b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else if (sub (lag, sub (tmp_lag, 2)) == 0) { 1273b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // limit search around T0 to the right side 1274b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac = 0; 1275b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber searchFrac (&lag, &frac, last_frac, corr, flag3); 1276b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1277b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else if (sub (lag, add(tmp_lag, 1)) == 0) { 1278b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // limit search around T0 to the left side 1279b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber last_frac = 0; 1280b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber searchFrac (&lag, &frac, last_frac, corr, flag3); 1281b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1282b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else { 1283b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // no fractional search 1284b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac = 0; 1285b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1286b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1287b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 1288b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // test the fractions around T0 1289b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber searchFrac (&lag, &frac, last_frac, corr, flag3); 1290b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1291b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1292b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber //----------------------------------------------------------------------- 1293b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // encode pitch 1294b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber //----------------------------------------------------------------------- 1295b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1296b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (flag3 != 0) { 1297b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // flag4 indicates encoding with 4 bit resolution; 1298b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // this is needed for mode MR475, MR515 and MR59 1299b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1300b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber flag4 = 0; 1301b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if ( (sub ((Word16)mode, (Word16)MR475) == 0) || 1302b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber (sub ((Word16)mode, (Word16)MR515) == 0) || 1303b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber (sub ((Word16)mode, (Word16)MR59) == 0) || 1304b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber (sub ((Word16)mode, (Word16)MR67) == 0) ) { 1305b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber flag4 = 1; 1306b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1307b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1308b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // encode with 1/3 subsample resolution 1309b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1310b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *ana_index = Enc_lag3(lag, frac, st->T0_prev_subframe, 1311b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0_min, t0_max, delta_search, flag4); 1312b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // function result 1313b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1314b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1315b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 1316b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 1317b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // encode with 1/6 subsample resolution 1318b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1319b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *ana_index = Enc_lag6(lag, frac, t0_min, delta_search); 1320b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // function result 1321b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1322b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1323b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber //----------------------------------------------------------------------- 1324b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // update state variables 1325b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber //----------------------------------------------------------------------- 1326b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1327b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber st->T0_prev_subframe = lag; 1328b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1329b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber //----------------------------------------------------------------------- 1330b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // update output variables 1331b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber //----------------------------------------------------------------------- 1332b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1333b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *resu3 = flag3; 1334b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1335b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *pit_frac = frac; 1336b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1337b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return (lag); 1338b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 1339b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1340b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1341b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 1342b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber RESOURCES USED [optional] 1343b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1344b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber When the code is written for a specific target processor the 1345b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber the resources used should be documented below. 1346b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1347b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber HEAP MEMORY USED: x bytes 1348b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1349b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber STACK MEMORY USED: x bytes 1350b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1351b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CLOCK CYCLES: (cycle count equation for this function) + (variable 1352b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber used to represent cycle count for each subroutine 1353b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber called) 1354b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber where: (cycle count variable) = cycle count for [subroutine 1355b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber name] 1356b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1357b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 1358b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CAUTION [optional] 1359b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber [State any special notes, constraints or cautions for users of this function] 1360b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1361b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 1362b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber*/ 1363b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas HuberWord16 Pitch_fr( /* o : pitch period (integer) */ 1364b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Pitch_frState *st, /* i/o : State struct */ 1365b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber enum Mode mode, /* i : codec mode */ 1366b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 T_op[], /* i : open loop pitch lags */ 1367b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 exc[], /* i : excitation buffer Q0 */ 1368b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 xn[], /* i : target vector Q0 */ 1369b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 h[], /* i : impulse response of synthesis and 1370b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber weighting filters Q12 */ 1371b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 L_subfr, /* i : Length of subframe */ 1372b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 i_subfr, /* i : subframe offset */ 1373b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *pit_frac, /* o : pitch period (fractional) */ 1374b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *resu3, /* o : subsample resolution 1/3 (=1) or 1/6 (=0) */ 1375b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *ana_index, /* o : index of encoding */ 1376b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Flag *pOverflow 1377b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber) 1378b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 1379b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 i; 1380b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 t_min; 1381b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 t_max; 1382b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 t0_min = 0; 1383b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 t0_max; 1384b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 max; 1385b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 lag; 1386b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 frac; 1387b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 tmp_lag; 1388b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *corr; 1389b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 corr_v[40]; /* Total length = t0_max-t0_min+1+2*L_INTER_SRCH */ 1390b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1391b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 max_frac_lag; 1392b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 flag3; 1393b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 flag4; 1394b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 last_frac; 1395b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 delta_int_low; 1396b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 delta_int_range; 1397b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 delta_frc_low; 1398b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 delta_frc_range; 1399b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 pit_min; 1400b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 frame_offset; 1401b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 delta_search; 1402b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1403b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /*-----------------------------------------------------------------------* 1404b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * set mode specific variables * 1405b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *-----------------------------------------------------------------------*/ 1406b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1407b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber max_frac_lag = mode_dep_parm[mode].max_frac_lag; 1408b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber flag3 = mode_dep_parm[mode].flag3; 1409b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac = mode_dep_parm[mode].first_frac; 1410b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber last_frac = mode_dep_parm[mode].last_frac; 1411b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber delta_int_low = mode_dep_parm[mode].delta_int_low; 1412b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber delta_int_range = mode_dep_parm[mode].delta_int_range; 1413b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1414b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber delta_frc_low = mode_dep_parm[mode].delta_frc_low; 1415b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber delta_frc_range = mode_dep_parm[mode].delta_frc_range; 1416b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pit_min = mode_dep_parm[mode].pit_min; 1417b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1418b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /*-----------------------------------------------------------------------* 1419b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * decide upon full or differential search * 1420b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *-----------------------------------------------------------------------*/ 1421b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1422b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber delta_search = 1; 1423b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1424b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if ((i_subfr == 0) || (i_subfr == L_FRAME_BY2)) 1425b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 1426b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1427b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* Subframe 1 and 3 */ 1428b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1429b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (((mode != MR475) && (mode != MR515)) || (i_subfr != L_FRAME_BY2)) 1430b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 1431b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1432b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* set t0_min, t0_max for full search */ 1433b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* this is *not* done for mode MR475, MR515 in subframe 3 */ 1434b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1435b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber delta_search = 0; /* no differential search */ 1436b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1437b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* calculate index into T_op which contains the open-loop */ 1438b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* pitch estimations for the 2 big subframes */ 1439b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1440b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frame_offset = 1; 1441b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (i_subfr == 0) 1442b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frame_offset = 0; 1443b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1444b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* get T_op from the corresponding half frame and */ 1445b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* set t0_min, t0_max */ 1446b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1447b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber getRange(T_op[frame_offset], delta_int_low, delta_int_range, 1448b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pit_min, PIT_MAX, &t0_min, &t0_max, pOverflow); 1449b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1450b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 1451b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 1452b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1453b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* mode MR475, MR515 and 3. Subframe: delta search as well */ 1454b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber getRange(st->T0_prev_subframe, delta_frc_low, delta_frc_range, 1455b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pit_min, PIT_MAX, &t0_min, &t0_max, pOverflow); 1456b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1457b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1458b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 1459b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 1460b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1461b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* for Subframe 2 and 4 */ 1462b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* get range around T0 of previous subframe for delta search */ 1463b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1464b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber getRange(st->T0_prev_subframe, delta_frc_low, delta_frc_range, 1465b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pit_min, PIT_MAX, &t0_min, &t0_max, pOverflow); 1466b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1467b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1468b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /*-----------------------------------------------------------------------* 1469b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * Find interval to compute normalized correlation * 1470b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *-----------------------------------------------------------------------*/ 1471b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1472b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t_min = sub(t0_min, L_INTER_SRCH, pOverflow); 1473b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t_max = add(t0_max, L_INTER_SRCH, pOverflow); 1474b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1475b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber corr = &corr_v[-t_min]; 1476b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1477b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /*-----------------------------------------------------------------------* 1478b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * Compute normalized correlation between target and filtered excitation * 1479b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *-----------------------------------------------------------------------*/ 1480b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1481b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Norm_Corr(exc, xn, h, L_subfr, t_min, t_max, corr, pOverflow); 1482b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1483b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /*-----------------------------------------------------------------------* 1484b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * Find integer pitch * 1485b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *-----------------------------------------------------------------------*/ 1486b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1487b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber max = corr[t0_min]; 1488b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber lag = t0_min; 1489b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1490b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = t0_min + 1; i <= t0_max; i++) 1491b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 1492b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (corr[i] >= max) 1493b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 1494b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber max = corr[i]; 1495b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber lag = i; 1496b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1497b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1498b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1499b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /*-----------------------------------------------------------------------* 1500b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * Find fractional pitch * 1501b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *-----------------------------------------------------------------------*/ 1502b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if ((delta_search == 0) && (lag > max_frac_lag)) 1503b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 1504b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1505b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* full search and integer pitch greater than max_frac_lag */ 1506b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* fractional search is not needed, set fractional to zero */ 1507b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1508b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac = 0; 1509b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1510b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 1511b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 1512b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1513b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* if differential search AND mode MR475 OR MR515 OR MR59 OR MR67 */ 1514b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* then search fractional with 4 bits resolution */ 1515b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1516b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if ((delta_search != 0) && 1517b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ((mode == MR475) || (mode == MR515) || 1518b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber (mode == MR59) || (mode == MR67))) 1519b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 1520b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1521b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* modify frac or last_frac according to position of last */ 1522b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* integer pitch: either search around integer pitch, */ 1523b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* or only on left or right side */ 1524b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1525b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tmp_lag = st->T0_prev_subframe; 1526b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (sub(sub(tmp_lag, t0_min, pOverflow), 5, pOverflow) > 0) 1527b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tmp_lag = add(t0_min, 5, pOverflow); 1528b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (sub(sub(t0_max, tmp_lag, pOverflow), 4, pOverflow) > 0) 1529b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tmp_lag = sub(t0_max, 4, pOverflow); 1530b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1531b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if ((lag == tmp_lag) || (lag == (tmp_lag - 1))) 1532b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 1533b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1534b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* normal search in fractions around T0 */ 1535b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1536b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber searchFrac(&lag, &frac, last_frac, corr, flag3, pOverflow); 1537b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1538b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1539b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else if (lag == (tmp_lag - 2)) 1540b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 1541b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* limit search around T0 to the right side */ 1542b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac = 0; 1543b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber searchFrac(&lag, &frac, last_frac, corr, flag3, pOverflow); 1544b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1545b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else if (lag == (tmp_lag + 1)) 1546b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 1547b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* limit search around T0 to the left side */ 1548b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber last_frac = 0; 1549b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber searchFrac(&lag, &frac, last_frac, corr, flag3, pOverflow); 1550b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1551b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 1552b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 1553b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* no fractional search */ 1554b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber frac = 0; 1555b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1556b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1557b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 1558b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* test the fractions around T0 */ 1559b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber searchFrac(&lag, &frac, last_frac, corr, flag3, pOverflow); 1560b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1561b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1562b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /*-----------------------------------------------------------------------* 1563b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * encode pitch * 1564b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *-----------------------------------------------------------------------*/ 1565b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1566b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (flag3 != 0) 1567b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 1568b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* flag4 indicates encoding with 4 bit resolution; */ 1569b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* this is needed for mode MR475, MR515 and MR59 */ 1570b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1571b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber flag4 = 0; 1572b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if ((mode == MR475) || (mode == MR515) || 1573b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber (mode == MR59) || (mode == MR67)) 1574b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 1575b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber flag4 = 1; 1576b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1577b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1578b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* encode with 1/3 subsample resolution */ 1579b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1580b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *ana_index = Enc_lag3(lag, frac, st->T0_prev_subframe, 1581b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0_min, t0_max, delta_search, flag4, pOverflow); 1582b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* function result */ 1583b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1584b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1585b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 1586b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 1587b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* encode with 1/6 subsample resolution */ 1588b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1589b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *ana_index = Enc_lag6(lag, frac, t0_min, delta_search, pOverflow); 1590b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* function result */ 1591b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 1592b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1593b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /*-----------------------------------------------------------------------* 1594b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * update state variables * 1595b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *-----------------------------------------------------------------------*/ 1596b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1597b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber st->T0_prev_subframe = lag; 1598b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1599b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /*-----------------------------------------------------------------------* 1600b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * update output variables * 1601b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *-----------------------------------------------------------------------*/ 1602b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1603b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *resu3 = flag3; 1604b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1605b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *pit_frac = frac; 1606b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1607b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return (lag); 1608b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 1609b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1610