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 Filename: /audio/gsm_amr/c/src/hp_max.c 35b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 36b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Date: 02/01/2002 37b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 38b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 39b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REVISION HISTORY 40b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 41b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Replaced "int" and/or "char" with OSCL defined types. 42b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 43b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: 44b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 45b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 46b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber*/ 47b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 48b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 49b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; INCLUDES 50b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 51b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "hp_max.h" 52b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "basic_op.h" 53b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "cnst.h" 54b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 55b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 56b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; MACROS 57b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; [Define module specific macros here] 58b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 59b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 60b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 61b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; DEFINES 62b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; [Include all pre-processor statements here. Include conditional 63b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; compile variables also.] 64b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 65b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 66b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 67b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; LOCAL FUNCTION DEFINITIONS 68b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; [List function prototypes here] 69b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 70b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 71b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 72b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; LOCAL VARIABLE DEFINITIONS 73b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; [Variable declaration - defined here and used outside this module] 74b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 75b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 76b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/* 77b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 78b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION NAME: hp_max 79b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 80b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber INPUT AND OUTPUT DEFINITIONS 81b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 82b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Inputs: 83b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber corr[] = correlation vector (Word16) 84b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scal_sig[] = scaled signal vector (Word16) 85b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_frame = length of frame to compute pitch (Word16 86b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber lag_max = maximum lag (Word16) 87b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber lag_min = minimum lag (Word16) 88b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber cor_hp_max = pointer to max high-pass filtered norm. correlation (Word16) 89b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow = pointer to overflow (Flag) 90b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 91b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Outputs: 92b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber cor_hp_max contains max high-pass filtered norm. correlation (Word16) 93b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow -> 1 if the maximum correlation computation resulted in overflow 94b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 95b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Returns: 96b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 0 (Word16) 97b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 98b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Global Variables Used: 99b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 100b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 101b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Local Variables Needed: 102b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 103b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 104b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 105b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION DESCRIPTION 106b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 107b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber This function finds the maximum high-pass filtered correlation of scal_sig[] 108b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber in a given delay range. 109b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 110b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber The correlation is given by 111b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber corr[t] = <scal_sig[n],scal_sig[n-t]>, t=lag_min,...,lag_max 112b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber The functions outputs the maximum high-pass filtered correlation after 113b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber normalization. 114b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 115b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 116b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REQUIREMENTS 117b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 118b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 119b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 120b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 121b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REFERENCES 122b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 123b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber [1] hp_max.c, UMTS GSM AMR speech codec, R99 - Version 3.2.0, March 2, 2001 124b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 125b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 126b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber PSEUDO-CODE 127b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 128b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas HuberWord16 hp_max ( 129b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 corr[], // i : correlation vector 130b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 scal_sig[], // i : scaled signal 131b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 L_frame, // i : length of frame to compute pitch 132b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 lag_max, // i : maximum lag 133b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 lag_min, // i : minimum lag 134b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *cor_hp_max) // o : max high-pass filtered norm. correlation 135b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 136b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 i; 137b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *p, *p1; 138b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 max, t0, t1; 139b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 max16, t016, cor_max; 140b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 shift, shift1, shift2; 141b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 142b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber max = MIN_32; 143b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = 0L; 144b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber* The reference ETSI code uses a global flag for Overflow inside the math functions 145b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber* saturate(). In the actual implementation a pointer to Overflow flag is passed in 146b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber* as a parameter to the function 147b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 148b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = lag_max-1; i > lag_min; i--) 149b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 150b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // high-pass filtering 151b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = L_sub (L_sub(L_shl(corr[-i], 1), corr[-i-1]), corr[-i+1]); 152b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = L_abs (t0); 153b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 154b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (L_sub (t0, max) >= 0) 155b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 156b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber max = t0; 157b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 158b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 159b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 160b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // compute energy 161b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p = scal_sig; 162b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p1 = &scal_sig[0]; 163b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = 0L; 164b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 0; i < L_frame; i++, p++, p1++) 165b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 166b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = L_mac (t0, *p, *p1); 167b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 168b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 169b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p = scal_sig; 170b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p1 = &scal_sig[-1]; 171b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t1 = 0L; 172b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 0; i < L_frame; i++, p++, p1++) 173b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 174b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t1 = L_mac (t1, *p, *p1); 175b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 176b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 177b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // high-pass filtering 178b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = L_sub(L_shl(t0, 1), L_shl(t1, 1)); 179b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = L_abs (t0); 180b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 181b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // max/t0 182b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber shift1 = sub(norm_l(max), 1); 183b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber max16 = extract_h(L_shl(max, shift1)); 184b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber shift2 = norm_l(t0); 185b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t016 = extract_h(L_shl(t0, shift2)); 186b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 187b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (t016 != 0) 188b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 189b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber cor_max = div_s(max16, t016); 190b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 191b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 192b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 193b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber cor_max = 0; 194b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 195b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 196b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber shift = sub(shift1, shift2); 197b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 198b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (shift >= 0) 199b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 200b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *cor_hp_max = shr(cor_max, shift); // Q15 201b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 202b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 203b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 204b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *cor_hp_max = shl(cor_max, negate(shift)); // Q15 205b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 206b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 207b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return 0; 208b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 209b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 210b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 211b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 212b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber RESOURCES USED [optional] 213b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 214b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber When the code is written for a specific target processor the 215b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber the resources used should be documented below. 216b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 217b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber HEAP MEMORY USED: x bytes 218b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 219b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber STACK MEMORY USED: x bytes 220b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 221b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CLOCK CYCLES: (cycle count equation for this function) + (variable 222b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber used to represent cycle count for each subroutine 223b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber called) 224b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber where: (cycle count variable) = cycle count for [subroutine 225b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber name] 226b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 227b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 228b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CAUTION [optional] 229b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber [State any special notes, constraints or cautions for users of this function] 230b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 231b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 232b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber*/ 233b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 234b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 235b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; FUNCTION CODE 236b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 237b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas HuberWord16 hp_max( 238b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 corr[], /* i : correlation vector. */ 239b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 scal_sig[], /* i : scaled signal. */ 240b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 L_frame, /* i : length of frame to compute pitch */ 241b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 lag_max, /* i : maximum lag */ 242b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 lag_min, /* i : minimum lag */ 243b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *cor_hp_max, /* o : max high-pass filtered norm. correlation */ 244b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Flag *pOverflow /* i/o : overflow Flag */ 245b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber) 246b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 247b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 i; 248b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *p, *p1; 249b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 max, t0, t1; 250b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 max16, t016, cor_max; 251b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 shift, shift1, shift2; 252b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 L_temp; 253b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 254b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber max = MIN_32; 255b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = 0L; 256b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 257b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = lag_max - 1; i > lag_min; i--) 258b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 259b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* high-pass filtering */ 260b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = L_shl(corr[-i], 1, pOverflow); 261b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_temp = L_sub(t0, corr[-i-1], pOverflow); 262b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = L_sub(L_temp, corr[-i+1], pOverflow); 263b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = L_abs(t0); 264b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 265b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (t0 >= max) 266b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 267b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber max = t0; 268b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 269b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 270b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 271b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* compute energy */ 272b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p = scal_sig; 273b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p1 = &scal_sig[0]; 274b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = 0L; 275b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 0; i < L_frame; i++, p++, p1++) 276b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 277b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = L_mac(t0, *p, *p1, pOverflow); 278b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 279b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 280b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p = scal_sig; 281b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p1 = &scal_sig[-1]; 282b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t1 = 0L; 283b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 0; i < L_frame; i++, p++, p1++) 284b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 285b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t1 = L_mac(t1, *p, *p1, pOverflow); 286b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 287b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 288b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* high-pass filtering */ 289b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_temp = L_shl(t0, 1, pOverflow); 290b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t1 = L_shl(t1, 1, pOverflow); 291b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = L_sub(L_temp, t1, pOverflow); 292b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t0 = L_abs(t0); 293b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 294b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* max/t0 */ 295b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* shift1 = sub(norm_l(max), 1); 296b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber max16 = extract_h(L_shl(max, shift1)); 297b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber shift2 = norm_l(t0); 298b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t016 = extract_h(L_shl(t0, shift2)); */ 299b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 300b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t016 = norm_l(max); 301b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber shift1 = sub(t016, 1, pOverflow); 302b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 303b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_temp = L_shl(max, shift1, pOverflow); 304b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber max16 = (Word16)(L_temp >> 16); 305b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 306b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber shift2 = norm_l(t0); 307b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_temp = L_shl(t0, shift2, pOverflow); 308b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t016 = (Word16)(L_temp >> 16); 309b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 310b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (t016 != 0) 311b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 312b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber cor_max = div_s(max16, t016); 313b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 314b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 315b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 316b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber cor_max = 0; 317b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 318b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 319b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber shift = sub(shift1, shift2, pOverflow); 320b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 321b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (shift >= 0) 322b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 323b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *cor_hp_max = shr(cor_max, shift, pOverflow); /* Q15 */ 324b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 325b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 326b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 327b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *cor_hp_max = shl(cor_max, negate(shift), pOverflow); /* Q15 */ 328b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 329b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 330b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return 0; 331b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 332b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 333