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/p_ol_wgh.c 35b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Funtions: p_ol_wgh_init 36b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_ol_wgh_reset 37b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_ol_wgh_exit 38b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Lag_max 39b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Pitch_ol_wgh 40b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 41b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Date: 02/05/2002 42b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 43b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REVISION HISTORY 44b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 45b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: t0 was not being declared as Word32. 46b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 47b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Replaced OSCL mem type functions and eliminated include 48b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber files that now are chosen by OSCL definitions 49b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 50b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Replaced "int" and/or "char" with OSCL defined types. 51b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 52b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Changed round function name to pv_round to avoid conflict with 53b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber round function in C standard library. 54b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 55b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: 56b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 57b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 58b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber MODULE DESCRIPTION 59b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 60b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber The modules in this file compute the open loop pitch lag with weighting. 61b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 62b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber*/ 63b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 64b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 65b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 66b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; INCLUDES 67b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 68b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include <stdlib.h> 69b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 70b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "p_ol_wgh.h" 71b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "typedef.h" 72b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "cnst.h" 73b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "basic_op.h" 74b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "gmed_n.h" 75b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "inv_sqrt.h" 76b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "vad1.h" 77b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "calc_cor.h" 78b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "hp_max.h" 79b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 80b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 81b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; MACROS 82b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; Define module specific macros here 83b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 84b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 85b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 86b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 87b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; DEFINES 88b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; Include all pre-processor statements here. Include conditional 89b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; compile variables also. 90b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 91b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 92b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 93b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; LOCAL FUNCTION DEFINITIONS 94b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; Function Prototype declaration 95b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 96b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 97b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 98b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; LOCAL VARIABLE DEFINITIONS 99b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; Variable declaration - defined here and used outside this module 100b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 101b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 102b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 103b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/* 104b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 105b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION NAME: p_ol_wgh_init 106b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 107b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber INPUT AND OUTPUT DEFINITIONS 108b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 109b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Inputs 110b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber state = pointer to a pointer of structure type pitchOLWghtState 111b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 112b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Outputs: 113b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 114b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 115b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Returns: 116b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 0 if the memory allocation is a success 117b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber -1 if the memory allocation fails 118b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 119b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Global Variables Used: 120b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None. 121b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 122b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Local Variables Needed: 123b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None. 124b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 125b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 126b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION DESCRIPTION 127b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 128b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber This function allocates state memory and initializes state memory 129b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 130b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 131b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REQUIREMENTS 132b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 133b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None. 134b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 135b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 136b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REFERENCES 137b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 138b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_ol_wgh.c, UMTS GSM AMR speech codec, R99 - Version 3.2.0, March 2, 2001 139b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 140b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 141b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber PSEUDO-CODE 142b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 143b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huberint p_ol_wgh_init (pitchOLWghtState **state) 144b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 145b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pitchOLWghtState* s; 146b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 147b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (state == (pitchOLWghtState **) NULL){ 148b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // fprintf(stderr, "p_ol_wgh_init: invalid parameter\n"); 149b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return -1; 150b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 151b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *state = NULL; 152b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 153b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // allocate memory 154b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if ((s= (pitchOLWghtState *) malloc(sizeof(pitchOLWghtState))) == NULL){ 155b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // fprintf(stderr, "p_ol_wgh_init: can not malloc state structure\n"); 156b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return -1; 157b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 158b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 159b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_ol_wgh_reset(s); 160b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 161b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *state = s; 162b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 163b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return 0; 164b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 165b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 166b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 167b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber RESOURCES USED [optional] 168b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 169b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber When the code is written for a specific target processor the 170b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber the resources used should be documented below. 171b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 172b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber HEAP MEMORY USED: x bytes 173b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 174b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber STACK MEMORY USED: x bytes 175b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 176b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CLOCK CYCLES: (cycle count equation for this function) + (variable 177b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber used to represent cycle count for each subroutine 178b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber called) 179b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber where: (cycle count variable) = cycle count for [subroutine 180b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber name] 181b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 182b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 183b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CAUTION [optional] 184b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber [State any special notes, constraints or cautions for users of this function] 185b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 186b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 187b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber*/ 188b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 189b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas HuberWord16 p_ol_wgh_init(pitchOLWghtState **state) 190b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 191b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pitchOLWghtState* s; 192b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 193b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (state == (pitchOLWghtState **) NULL) 194b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 195b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* fprintf(stderr, "p_ol_wgh_init: invalid parameter\n"); */ 196b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return -1; 197b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 198b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *state = NULL; 199b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 200b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* allocate memory */ 201b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if ((s = (pitchOLWghtState *) malloc(sizeof(pitchOLWghtState))) == NULL) 202b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 203b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* fprintf(stderr, "p_ol_wgh_init: can not malloc state structure\n"); */ 204b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return -1; 205b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 206b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 207b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_ol_wgh_reset(s); 208b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 209b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *state = s; 210b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 211b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return 0; 212b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 213b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 214b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 215b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; End Function: p_ol_wgh_init 216b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 217b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 218b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/* 219b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 220b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION NAME: p_ol_wgh_reset 221b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 222b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber INPUT AND OUTPUT DEFINITIONS 223b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 224b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Inputs 225b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber st = pointer to structure type pitchOLWghtState 226b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 227b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Outputs: 228b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 229b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 230b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Returns: 231b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 0 if the memory initialization is a success 232b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber -1 if the memory initialization fails 233b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 234b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Global Variables Used: 235b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None. 236b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 237b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Local Variables Needed: 238b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None. 239b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 240b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 241b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION DESCRIPTION 242b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 243b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber This function initializes state memory to zero 244b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 245b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 246b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REQUIREMENTS 247b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 248b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None. 249b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 250b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 251b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REFERENCES 252b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 253b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_ol_wgh.c, UMTS GSM AMR speech codec, R99 - Version 3.2.0, March 2, 2001 254b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 255b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 256b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber PSEUDO-CODE 257b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 258b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huberint p_ol_wgh_reset (pitchOLWghtState *st) 259b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 260b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (st == (pitchOLWghtState *) NULL){ 261b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // fprintf(stderr, "p_ol_wgh_reset: invalid parameter\n"); 262b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return -1; 263b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 264b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 265b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // Reset pitch search states 266b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber st->old_T0_med = 40; 267b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber st->ada_w = 0; 268b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber st->wght_flg = 0; 269b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 270b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return 0; 271b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 272b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 273b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 274b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber RESOURCES USED [optional] 275b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 276b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber When the code is written for a specific target processor the 277b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber the resources used should be documented below. 278b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 279b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber HEAP MEMORY USED: x bytes 280b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 281b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber STACK MEMORY USED: x bytes 282b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 283b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CLOCK CYCLES: (cycle count equation for this function) + (variable 284b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber used to represent cycle count for each subroutine 285b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber called) 286b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber where: (cycle count variable) = cycle count for [subroutine 287b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber name] 288b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 289b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 290b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CAUTION [optional] 291b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber [State any special notes, constraints or cautions for users of this function] 292b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 293b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 294b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber*/ 295b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 296b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas HuberWord16 p_ol_wgh_reset(pitchOLWghtState *st) 297b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 298b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (st == (pitchOLWghtState *) NULL) 299b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 300b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* fprintf(stderr, "p_ol_wgh_reset: invalid parameter\n"); */ 301b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return -1; 302b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 303b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 304b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* Reset pitch search states */ 305b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber st->old_T0_med = 40; 306b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber st->ada_w = 0; 307b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber st->wght_flg = 0; 308b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 309b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return 0; 310b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 311b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 312b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 313b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; End Function: p_ol_wgh_reset 314b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 315b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 316b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/* 317b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 318b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION NAME: p_ol_wgh_exit 319b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 320b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber INPUT AND OUTPUT DEFINITIONS 321b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 322b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Inputs 323b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber st = pointer to a pointer of structure type pitchOLWghtState 324b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 325b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Outputs: 326b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 327b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 328b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Returns: 329b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 0 if the memory initialization is a success 330b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber -1 if the memory initialization fails 331b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 332b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Global Variables Used: 333b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None. 334b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 335b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Local Variables Needed: 336b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None. 337b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 338b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 339b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION DESCRIPTION 340b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 341b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber This function frees the memory used for state memory 342b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 343b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 344b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REQUIREMENTS 345b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 346b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None. 347b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 348b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 349b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REFERENCES 350b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 351b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_ol_wgh.c, UMTS GSM AMR speech codec, R99 - Version 3.2.0, March 2, 2001 352b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 353b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 354b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber PSEUDO-CODE 355b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 356b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Hubervoid p_ol_wgh_exit (pitchOLWghtState **state) 357b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 358b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (state == NULL || *state == NULL) 359b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return; 360b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 361b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // deallocate memory 362b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber free(*state); 363b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *state = NULL; 364b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 365b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return; 366b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 367b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 368b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 369b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber RESOURCES USED [optional] 370b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 371b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber When the code is written for a specific target processor the 372b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber the resources used should be documented below. 373b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 374b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber HEAP MEMORY USED: x bytes 375b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 376b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber STACK MEMORY USED: x bytes 377b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 378b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CLOCK CYCLES: (cycle count equation for this function) + (variable 379b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber used to represent cycle count for each subroutine 380b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber called) 381b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber where: (cycle count variable) = cycle count for [subroutine 382b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber name] 383b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 384b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 385b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CAUTION [optional] 386b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber [State any special notes, constraints or cautions for users of this function] 387b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 388b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 389b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber*/ 390b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 391b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Hubervoid p_ol_wgh_exit(pitchOLWghtState **state) 392b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 393b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (state == NULL || *state == NULL) 394b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return; 395b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 396b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* deallocate memory */ 397b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber free(*state); 398b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *state = NULL; 399b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 400b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return; 401b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 402b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 403b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 404b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 405b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; End Function: p_ol_wgh_exit 406b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 407b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/* 408b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 409b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION NAME: Lag_max 410b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 411b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber INPUT AND OUTPUT DEFINITIONS 412b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 413b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Inputs: 414b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber corr = pointer to buffer of correlation values (Word32) 415b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_sig = pointer to buffer of scaled signal values (Word16) 416b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_fac = scaled signal factor (Word16) 417b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_flag = EFR compatible scaling flag (Word16) 418b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_frame = length of frame to compute pitch (Word16) 419b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber lag_max = maximum lag (Word16) 420b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber lag_min = minimum lag (Word16) 421b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber cor_max = pointer to the normalized correlation of selected lag (Word16) 422b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber rmax = pointer to max(<s[i]*s[j]>), (Word32) 423b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber r0 = pointer to the residual energy (Word32) 424b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dtx = dtx flag; equal to 1, if dtx is enabled, 0, otherwise (Flag) 425b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow = Pointer to overflow (Flag) 426b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 427b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Outputs: 428b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber cor_max contains the newly calculated normalized correlation of the 429b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber selected lag 430b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber rmax contains the newly calculated max(<s[i]*s[j]>) 431b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber r0 contains the newly calculated residual energy 432b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow -> 1 if the math functions called by this routine saturate. 433b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 434b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Returns: 435b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_max = lag of the max correlation found (Word16) 436b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 437b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Global Variables Used: 438b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None. 439b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 440b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Local Variables Needed: 441b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None. 442b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 443b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 444b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION DESCRIPTION 445b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 446b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber This function finds the lag that has maximum correlation of scal_sig[] in a 447b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber given delay range. 448b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber The correlation is given by 449b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber cor[t] = <scal_sig[n],scal_sig[n-t]>, t=lag_min,...,lag_max 450b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber The functions outputs the maximum correlation after normalization and the 451b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber corresponding lag. 452b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 453b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 454b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REQUIREMENTS 455b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 456b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None. 457b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 458b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 459b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REFERENCES 460b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 461b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_ol_wgh.c, UMTS GSM AMR speech codec, R99 - Version 3.2.0, March 2, 2001 462b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 463b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 464b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber PSEUDO-CODE 465b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 466b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huberstatic Word16 Lag_max ( // o : lag found 467b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber vadState *vadSt, // i/o : VAD state struct 468b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 corr[], // i : correlation vector. 469b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 scal_sig[], // i : scaled signal. 470b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 L_frame, // i : length of frame to compute pitch 471b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 lag_max, // i : maximum lag 472b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 lag_min, // i : minimum lag 473b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 old_lag, // i : old open-loop lag 474b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *cor_max, // o : normalized correlation of selected lag 475b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 wght_flg, // i : is weighting function used 476b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *gain_flg, // o : open-loop flag 477b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Flag dtx // i : dtx flag; use dtx=1, do not use dtx=0 478b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ) 479b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 480b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 i, j; 481b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *p, *p1; 482b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 max, t0; 483b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 t0_h, t0_l; 484b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 p_max; 485b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber const Word16 *ww, *we; 486b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 t1; 487b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 488b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ww = &corrweight[250]; 489b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber we = &corrweight[123 + lag_max - old_lag]; 490b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 491b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber max = MIN_32; 492b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_max = lag_max; 493b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 494b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = lag_max; i >= lag_min; i--) 495b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 496b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = corr[-i]; 497b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 498b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // Weighting of the correlation function. 499b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_Extract (corr[-i], &t0_h, &t0_l); 500b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = Mpy_32_16 (t0_h, t0_l, *ww); 501b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ww--; 502b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (wght_flg > 0) { 503b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // Weight the neighbourhood of the old lag 504b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_Extract (t0, &t0_h, &t0_l); 505b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = Mpy_32_16 (t0_h, t0_l, *we); 506b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber we--; 507b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 508b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 509b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (L_sub (t0, max) >= 0) 510b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 511b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber max = t0; 512b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_max = i; 513b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 514b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 515b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 516b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p = &scal_sig[0]; 517b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p1 = &scal_sig[-p_max]; 518b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = 0; 519b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t1 = 0; 520b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 521b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (j = 0; j < L_frame; j++, p++, p1++) 522b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 523b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = L_mac (t0, *p, *p1); 524b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t1 = L_mac (t1, *p1, *p1); 525b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 526b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 527b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (dtx) 528b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { // no test() call since this if is only in simulation env 529b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#ifdef VAD2 530b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber vadSt->L_Rmax = L_add(vadSt->L_Rmax, t0); // Save max correlation 531b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber vadSt->L_R0 = L_add(vadSt->L_R0, t1); // Save max energy 532b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#else 533b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // update and detect tone 534b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber vad_tone_detection_update (vadSt, 0); 535b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber vad_tone_detection (vadSt, t0, t1); 536b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#endif 537b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 538b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 539b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // gain flag is set according to the open_loop gain 540b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // is t2/t1 > 0.4 ? 541b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *gain_flg = pv_round(L_msu(t0, pv_round(t1), 13107)); 542b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 543b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *cor_max = 0; 544b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 545b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return (p_max); 546b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 547b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 548b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 549b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber RESOURCES USED [optional] 550b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 551b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber When the code is written for a specific target processor the 552b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber the resources used should be documented below. 553b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 554b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber HEAP MEMORY USED: x bytes 555b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 556b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber STACK MEMORY USED: x bytes 557b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 558b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CLOCK CYCLES: (cycle count equation for this function) + (variable 559b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber used to represent cycle count for each subroutine 560b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber called) 561b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber where: (cycle count variable) = cycle count for [subroutine 562b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber name] 563b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 564b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 565b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CAUTION [optional] 566b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber [State any special notes, constraints or cautions for users of this function] 567b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 568b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 569b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber*/ 570b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 571b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huberstatic Word16 Lag_max( /* o : lag found */ 572b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber vadState *vadSt, /* i/o : VAD state struct */ 573b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 corr[], /* i : correlation vector. */ 574b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 scal_sig[], /* i : scaled signal. */ 575b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 L_frame, /* i : length of frame to compute pitch */ 576b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 lag_max, /* i : maximum lag */ 577b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 lag_min, /* i : minimum lag */ 578b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 old_lag, /* i : old open-loop lag */ 579b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *cor_max, /* o : normalized correlation of selected lag */ 580b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 wght_flg, /* i : is weighting function used */ 581b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *gain_flg, /* o : open-loop flag */ 582b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Flag dtx, /* i : dtx flag; use dtx=1, do not use dtx=0 */ 583b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Flag *pOverflow /* o : overflow flag */ 584b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber) 585b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 586b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 i; 587b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 j; 588b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *p; 589b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *p1; 590b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 max; 591b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 t0; 592b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 t0_h; 593b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 t0_l; 594b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 p_max; 595b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber const Word16 *ww; 596b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber const Word16 *we; 597b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 t1; 598b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 temp; 599b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 600b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ww = &corrweight[250]; 601b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber we = &corrweight[123 + lag_max - old_lag]; 602b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 603b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber max = MIN_32; 604b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_max = lag_max; 605b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 606b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = lag_max; i >= lag_min; i--) 607b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 608b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = corr[-i]; 609b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 610b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* Weighting of the correlation function. */ 611b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_Extract(corr[-i], &t0_h, &t0_l, pOverflow); 612b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = Mpy_32_16(t0_h, t0_l, *ww, pOverflow); 613b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ww--; 614b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (wght_flg > 0) 615b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 616b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* Weight the neighbourhood of the old lag. */ 617b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_Extract(t0, &t0_h, &t0_l, pOverflow); 618b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = Mpy_32_16(t0_h, t0_l, *we, pOverflow); 619b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber we--; 620b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 621b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 622b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* if (L_sub (t0, max) >= 0) */ 623b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (t0 >= max) 624b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 625b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber max = t0; 626b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_max = i; 627b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 628b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 629b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p = &scal_sig[0]; 630b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p1 = &scal_sig[-p_max]; 631b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = 0; 632b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t1 = 0; 633b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 634b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (j = 0; j < L_frame; j++, p++, p1++) 635b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 636b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = L_mac(t0, *p, *p1, pOverflow); 637b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t1 = L_mac(t1, *p1, *p1, pOverflow); 638b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 639b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 640b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (dtx) 641b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { /* no test() call since this if is only in simulation env */ 642b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#ifdef VAD2 643b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* Save max correlation */ 644b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber vadSt->L_Rmax = L_add(vadSt->L_Rmax, t0, pOverflow); 645b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* Save max energy */ 646b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber vadSt->L_R0 = L_add(vadSt->L_R0, t1, pOverflow); 647b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#else 648b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* update and detect tone */ 649b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber vad_tone_detection_update(vadSt, 0, pOverflow); 650b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber vad_tone_detection(vadSt, t0, t1, pOverflow); 651b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#endif 652b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 653b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 654b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* gain flag is set according to the open_loop gain */ 655b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* is t2/t1 > 0.4 ? */ 656b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber temp = pv_round(t1, pOverflow); 657b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t1 = L_msu(t0, temp, 13107, pOverflow); 658b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *gain_flg = pv_round(t1, pOverflow); 659b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 660b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *cor_max = 0; 661b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 662b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return (p_max); 663b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 664b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 665b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; End Function: Lag_max 666b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 667b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 668b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/* 669b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 670b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION NAME: Pitch_ol_wgh 671b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 672b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber INPUT AND OUTPUT DEFINITIONS 673b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 674b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Inputs: 675b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber st = pointer to pitchOLWghtState structure 676b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber vadSt = pointer to a vadState structure 677b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber signal = pointer to buffer of signal used to compute the open loop 678b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pitch where signal[-pit_max] to signal[-1] should be known 679b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pit_min = 16 bit value specifies the minimum pitch lag 680b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pit_max = 16 bit value specifies the maximum pitch lag 681b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_frame = 16 bit value specifies the length of frame to compute pitch 682b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber old_lags = pointer to history with old stored Cl lags (Word16) 683b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ol_gain_flg = pointer to OL gain flag (Word16) 684b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber idx = 16 bit value specifies the frame index 685b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dtx = Data of type 'Flag' used for dtx. Use dtx=1, do not use dtx=0 686b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow = pointer to Overflow indicator (Flag) 687b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Outputs 688b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber st = The pitchOLWghtState may be modified 689b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber vadSt = The vadSt state structure may be modified. 690b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow -> 1 if the math functions invoked by this routine saturate. 691b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 692b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Returns: 693b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_max1 = 16 bit value representing the open loop pitch lag. 694b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 695b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Global Variables Used: 696b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None. 697b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 698b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Local Variables Needed: 699b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None. 700b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 701b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 702b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION DESCRIPTION 703b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 704b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber This function performs an open-loop pitch search with weighting 705b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 706b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REQUIREMENTS 707b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 708b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None. 709b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 710b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 711b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REFERENCES 712b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 713b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pitch_ol.c, UMTS GSM AMR speech codec, R99 - Version 3.2.0, March 2, 2001 714b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 715b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 716b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber PSEUDO-CODE 717b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 718b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas HuberWord16 Pitch_ol_wgh ( // o : open loop pitch lag 719b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pitchOLWghtState *st, // i/o : State struct 720b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber vadState *vadSt, // i/o : VAD state struct/ 721b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 signal[], // i : signal used to compute the open loop pitch 722b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // signal[-pit_max] to signal[-1] should be known 723b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 pit_min, // i : minimum pitch lag 724b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 pit_max, // i : maximum pitch lag 725b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 L_frame, // i : length of frame to compute pitch 726b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 old_lags[], // i : history with old stored Cl lags 727b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 ol_gain_flg[], // i : OL gain flag 728b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 idx, // i : index 729b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Flag dtx // i : dtx flag; use dtx=1, do not use dtx=0 730b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ) 731b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 732b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 i; 733b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 max1; 734b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 p_max1; 735b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 t0; 736b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#ifndef VAD2 737b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 corr_hp_max; 738b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#endif 739b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 corr[PIT_MAX+1], *corr_ptr; 740b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 741b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // Scaled signal 742b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 scaled_signal[PIT_MAX + L_FRAME]; 743b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *scal_sig; 744b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 745b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_sig = &scaled_signal[pit_max]; 746b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 747b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = 0L; 748b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = -pit_max; i < L_frame; i++) 749b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 750b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = L_mac (t0, signal[i], signal[i]); 751b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 752b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // 753b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // Scaling of input signal 754b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // 755b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // if Overflow -> scal_sig[i] = signal[i]>>2 756b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // else if t0 < 1^22 -> scal_sig[i] = signal[i]<<2 757b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // else -> scal_sig[i] = signal[i] 758b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 759b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // 760b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // Verification for risk of overflow. 761b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // 762b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 763b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // Test for overflow 764b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (L_sub (t0, MAX_32) == 0L) 765b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 766b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = -pit_max; i < L_frame; i++) 767b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 768b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_sig[i] = shr (signal[i], 3); 769b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 770b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 771b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else if (L_sub (t0, (Word32) 1048576L) < (Word32) 0) 772b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 773b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = -pit_max; i < L_frame; i++) 774b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 775b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_sig[i] = shl (signal[i], 3); 776b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 777b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 778b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 779b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 780b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = -pit_max; i < L_frame; i++) 781b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 782b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_sig[i] = signal[i]; 783b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 784b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 785b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 786b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // calculate all coreelations of scal_sig, from pit_min to pit_max 787b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber corr_ptr = &corr[pit_max]; 788b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber comp_corr (scal_sig, L_frame, pit_max, pit_min, corr_ptr); 789b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 790b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_max1 = Lag_max (vadSt, corr_ptr, scal_sig, L_frame, pit_max, pit_min, 791b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber st->old_T0_med, &max1, st->wght_flg, &ol_gain_flg[idx], 792b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dtx); 793b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 794b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (ol_gain_flg[idx] > 0) 795b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 796b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // Calculate 5-point median of previous lag 797b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 4; i > 0; i--) // Shift buffer 798b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 799b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber old_lags[i] = old_lags[i-1]; 800b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 801b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber old_lags[0] = p_max1; 802b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber st->old_T0_med = gmed_n (old_lags, 5); 803b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber st->ada_w = 32767; // Q15 = 1.0 804b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 805b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 806b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 807b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber st->old_T0_med = p_max1; 808b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber st->ada_w = mult(st->ada_w, 29491); // = ada_w = ada_w * 0.9 809b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 810b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 811b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (sub(st->ada_w, 9830) < 0) // ada_w - 0.3 812b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 813b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber st->wght_flg = 0; 814b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 815b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 816b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 817b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber st->wght_flg = 1; 818b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 819b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 820b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#ifndef VAD2 821b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (dtx) 822b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { // no test() call since this if is only in simulation env 823b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (sub(idx, 1) == 0) 824b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 825b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // calculate max high-passed filtered correlation of all lags 826b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber hp_max (corr_ptr, scal_sig, L_frame, pit_max, pit_min, &corr_hp_max); 827b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 828b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // update complex background detector 829b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber vad_complex_detection_update(vadSt, corr_hp_max); 830b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 831b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 832b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#endif 833b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 834b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return (p_max1); 835b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 836b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 837b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 838b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber RESOURCES USED [optional] 839b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 840b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber When the code is written for a specific target processor the 841b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber the resources used should be documented below. 842b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 843b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber HEAP MEMORY USED: x bytes 844b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 845b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber STACK MEMORY USED: x bytes 846b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 847b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CLOCK CYCLES: (cycle count equation for this function) + (variable 848b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber used to represent cycle count for each subroutine 849b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber called) 850b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber where: (cycle count variable) = cycle count for [subroutine 851b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber name] 852b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 853b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 854b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CAUTION [optional] 855b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber [State any special notes, constraints or cautions for users of this function] 856b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 857b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 858b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber*/ 859b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 860b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas HuberWord16 Pitch_ol_wgh( /* o : open loop pitch lag */ 861b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pitchOLWghtState *st, /* i/o : State struct */ 862b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber vadState *vadSt, /* i/o : VAD state struct */ 863b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 signal[], /* i : signal used to compute the open loop pitch */ 864b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* signal[-pit_max] to signal[-1] should be known */ 865b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 pit_min, /* i : minimum pitch lag */ 866b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 pit_max, /* i : maximum pitch lag */ 867b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 L_frame, /* i : length of frame to compute pitch */ 868b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 old_lags[], /* i : history with old stored Cl lags */ 869b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 ol_gain_flg[], /* i : OL gain flag */ 870b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 idx, /* i : index */ 871b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Flag dtx, /* i : dtx flag; use dtx=1, do not use dtx=0 */ 872b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Flag *pOverflow /* o : overflow flag */ 873b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber) 874b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 875b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 i; 876b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 max1; 877b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 p_max1; 878b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 t0; 879b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#ifndef VAD2 880b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 corr_hp_max; 881b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#endif 882b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 corr[PIT_MAX+1], *corr_ptr; 883b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 884b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* Scaled signal */ 885b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 scaled_signal[PIT_MAX + L_FRAME]; 886b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *scal_sig; 887b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 888b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_sig = &scaled_signal[pit_max]; 889b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 890b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = 0L; 891b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = -pit_max; i < L_frame; i++) 892b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 893b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = L_mac(t0, signal[i], signal[i], pOverflow); 894b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 895b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /*--------------------------------------------------------* 896b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * Scaling of input signal. * 897b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * * 898b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * if Overflow -> scal_sig[i] = signal[i]>>2 * 899b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * else if t0 < 1^22 -> scal_sig[i] = signal[i]<<2 * 900b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * else -> scal_sig[i] = signal[i] * 901b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *--------------------------------------------------------*/ 902b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 903b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /*--------------------------------------------------------* 904b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * Verification for risk of overflow. * 905b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *--------------------------------------------------------*/ 906b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 907b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* Test for overflow */ 908b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (L_sub(t0, MAX_32, pOverflow) == 0L) 909b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 910b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = -pit_max; i < L_frame; i++) 911b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 912b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_sig[i] = shr(signal[i], 3, pOverflow); 913b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 914b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 915b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else if (L_sub(t0, (Word32) 1048576L, pOverflow) < (Word32) 0) 916b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 917b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = -pit_max; i < L_frame; i++) 918b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 919b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_sig[i] = shl(signal[i], 3, pOverflow); 920b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 921b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 922b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 923b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 924b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = -pit_max; i < L_frame; i++) 925b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 926b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_sig[i] = signal[i]; 927b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 928b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 929b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 930b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* calculate all coreelations of scal_sig, from pit_min to pit_max */ 931b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber corr_ptr = &corr[pit_max]; 932b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber comp_corr(scal_sig, L_frame, pit_max, pit_min, corr_ptr); 933b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 934b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_max1 = Lag_max(vadSt, corr_ptr, scal_sig, L_frame, pit_max, pit_min, 935b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber st->old_T0_med, &max1, st->wght_flg, &ol_gain_flg[idx], 936b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dtx, pOverflow); 937b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 938b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (ol_gain_flg[idx] > 0) 939b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 940b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* Calculate 5-point median of previous lags */ 941b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 4; i > 0; i--) /* Shift buffer */ 942b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 943b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber old_lags[i] = old_lags[i-1]; 944b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 945b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber old_lags[0] = p_max1; 946b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber st->old_T0_med = gmed_n(old_lags, 5); 947b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber st->ada_w = 32767; /* Q15 = 1.0 */ 948b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 949b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 950b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 951b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber st->old_T0_med = p_max1; 952b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* = ada_w = ada_w * 0.9 */ 953b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber st->ada_w = mult(st->ada_w, 29491, pOverflow); 954b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 955b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 956b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (sub(st->ada_w, 9830, pOverflow) < 0) /* ada_w - 0.3 */ 957b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 958b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber st->wght_flg = 0; 959b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 960b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 961b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 962b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber st->wght_flg = 1; 963b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 964b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 965b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#ifndef VAD2 966b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (dtx) 967b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { /* no test() call since this if is only in simulation env */ 968b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (sub(idx, 1, pOverflow) == 0) 969b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 970b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* calculate max high-passed filtered correlation of all lags */ 971b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber hp_max(corr_ptr, scal_sig, L_frame, pit_max, pit_min, &corr_hp_max, pOverflow); 972b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 973b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* update complex background detector */ 974b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber vad_complex_detection_update(vadSt, corr_hp_max); 975b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 976b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 977b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#endif 978b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 979b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return (p_max1); 980b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 981b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 982b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 983b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; End Function: Pitch_ol_wgh 984b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 985b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 986b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 987b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 988b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 989b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 990