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/set_sign.c 35b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Funtions: set_sign 36b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber set_sign12k2 37b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 38b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Date: 05/26/2000 39b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 40b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 41b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REVISION HISTORY 42b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 43b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Placed into PV template and optimized. 44b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 45b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Synchronized file with UMTS version 3.2.0. Updated coding 46b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber template. Removed unnecessary include files. 47b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 48b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Replaced basic_op.h with the header files of the math functions 49b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber used in the file. 50b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 51b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Made the following changes per comments from Phase 2/3 review: 52b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1. Modified certain FOR loops to count down. 53b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 2. Modified code for further optimization. 54b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 55b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Modified FOR loops in set_sign12k2 to count up. The FOR loops 56b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber affected are the loop that calculates the starting position of 57b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber each incoming pulse, and the loop that calculates the position 58b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber of the max correlation. Updated copyright year. 59b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 60b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Passing in pointer to overflow flag for EPOC compatibility. 61b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 62b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: For set_sign12k2() 63b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1. Eliminated unused include files. 64b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 2. Replaced array addressing by pointers 65b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 3. Eliminated math operations that unnecessary checked for 66b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber saturation, this by evaluating the operands 67b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 4. Replaced loop counter with decrement loops 68b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 69b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Replaced "int" and/or "char" with OSCL defined types. 70b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 71b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Changed round function name to pv_round to avoid conflict with 72b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber round function in C standard library. 73b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 74b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: 75b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 76b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 77b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber MODULE DESCRIPTION 78b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 79b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber This module contains the functions set_sign and set_sign12k2. 80b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber These functions are used to build a sign vector according 81b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber to the values in the input arrays. These functions also 82b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber find the position in the input codes of the maximum correlation 83b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber and the starting position for each pulse. 84b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 85b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 86b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber*/ 87b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 88b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 89b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 90b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; INCLUDES 91b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 92b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "set_sign.h" 93b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "basic_op.h" 94b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "inv_sqrt.h" 95b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "cnst.h" 96b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 97b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 98b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 99b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; MACROS 100b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; Define module specific macros here 101b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 102b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 103b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 104b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 105b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; DEFINES 106b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; Include all pre-processor statements here. Include conditional 107b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; compile variables also. 108b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 109b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 110b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 111b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; LOCAL FUNCTION DEFINITIONS 112b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; Function Prototype declaration 113b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 114b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 115b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 116b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; LOCAL VARIABLE DEFINITIONS 117b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; Variable declaration - defined here and used outside this module 118b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 119b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 120b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 121b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/* 122b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 123b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION NAME: set_sign 124b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 125b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber INPUT AND OUTPUT DEFINITIONS 126b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 127b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Inputs: 128b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dn = buffer of correlation values (Word16) 129b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber sign = buffer containing sign of dn elements (Word16) 130b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dn2 = buffer containing the maximum of correlation in each track.(Word16) 131b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber n = number of maximum correlations in dn2 (Word16) 132b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 133b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Returns: 134b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 135b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 136b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Outputs: 137b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dn buffer is modified to contain the absolute value of its input 138b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber sign buffer is modified to contain the sign information for the 139b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber values in dn buffer 140b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dn2 buffer is modified to denote the location of the maximum 141b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber correlation for each track. 142b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 143b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Global Variables Used: 144b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 145b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 146b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Local Variables Needed: 147b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 148b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 149b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 150b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION DESCRIPTION 151b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 152b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 153b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber This function builds sign vector according to dn buffer It also finds 154b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber the position of maximum of correlation in each track and the starting 155b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber position for each pulse. 156b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 157b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 158b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REQUIREMENTS 159b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 160b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None. 161b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 162b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 163b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REFERENCES 164b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 165b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber set_sign.c, UMTS GSM AMR speech codec, R99 - Version 3.2.0, March 2, 2001 166b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 167b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 168b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber PSEUDO-CODE 169b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 170b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Hubervoid set_sign(Word16 dn[], i/o : correlation between target and h[] 171b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 sign[], o : sign of dn[] 172b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 dn2[], o : maximum of correlation in each track. 173b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 n i : # of maximum correlations in dn2[] 174b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber) 175b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 176b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 i, j, k; 177b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 val, min; 178b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 pos = 0; //initialization only needed to keep gcc silent 179b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 180b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // set sign according to dn[] 181b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 182b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 0; i < L_CODE; i++) { 183b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber val = dn[i]; 184b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 185b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (val >= 0) { 186b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber sign[i] = 32767; 187b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } else { 188b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber sign[i] = -32767; 189b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber val = negate(val); 190b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 191b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dn[i] = val; // modify dn[] according to the fixed sign 192b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dn2[i] = val; 193b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 194b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 195b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // keep 8-n maximum positions/8 of each track and store it in dn2[] 196b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 197b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 0; i < NB_TRACK; i++) 198b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 199b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (k = 0; k < (8-n); k++) 200b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 201b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber min = 0x7fff; 202b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (j = i; j < L_CODE; j += STEP) 203b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 204b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (dn2[j] >= 0) 205b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 206b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber val = sub(dn2[j], min); 207b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 208b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (val < 0) 209b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 210b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber min = dn2[j]; 211b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pos = j; 212b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 213b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 214b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 215b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dn2[pos] = -1; 216b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 217b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 218b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 219b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return; 220b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 221b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 222b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 223b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber RESOURCES USED [optional] 224b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 225b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber When the code is written for a specific target processor the 226b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber the resources used should be documented below. 227b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 228b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber HEAP MEMORY USED: x bytes 229b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 230b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber STACK MEMORY USED: x bytes 231b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 232b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CLOCK CYCLES: (cycle count equation for this function) + (variable 233b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber used to represent cycle count for each subroutine 234b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber called) 235b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber where: (cycle count variable) = cycle count for [subroutine 236b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber name] 237b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 238b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 239b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CAUTION [optional] 240b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber [State any special notes, constraints or cautions for users of this function] 241b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 242b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 243b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber*/ 244b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 245b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Hubervoid set_sign(Word16 dn[], /* i/o : correlation between target and h[] */ 246b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 sign[], /* o : sign of dn[] */ 247b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 dn2[], /* o : maximum of correlation in each track. */ 248b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 n /* i : # of maximum correlations in dn2[] */ 249b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ) 250b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 251b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber register Word16 i, j, k; 252b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 val, min; 253b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 pos = 0; /* initialization only needed to keep gcc silent */ 254b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 255b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* set sign according to dn[] */ 256b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = L_CODE - 1; i >= 0; i--) 257b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 258b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber val = dn[i]; 259b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 260b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (val >= 0) 261b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 262b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber sign[i] = 32767; 263b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 264b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 265b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 266b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber sign[i] = -32767; 267b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber val = negate(val); 268b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dn[i] = val; /* modify dn[] according to the fixed sign */ 269b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 270b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 271b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dn2[i] = val; 272b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 273b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 274b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* keep 8-n maximum positions/8 of each track and store it in dn2[] */ 275b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 276b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 0; i < NB_TRACK; i++) 277b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 278b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (k = 0; k < (8 - n); k++) 279b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 280b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber min = 0x7fff; 281b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (j = i; j < L_CODE; j += STEP) 282b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 283b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (dn2[j] >= 0) 284b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 285b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (dn2[j] < min) 286b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 287b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber min = dn2[j]; 288b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pos = j; 289b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 290b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 291b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 292b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dn2[pos] = -1; 293b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 294b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 295b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 296b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return; 297b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 298b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 299b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/****************************************************************************/ 300b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 301b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 302b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/* 303b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 304b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION NAME: set_sign12k2() 305b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 306b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber INPUT AND OUTPUT DEFINITIONS 307b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 308b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Inputs: 309b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dn = buffer of correlation values (Word16) 310b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber cn = buffer of residual after long term prediction (Word16) 311b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber sign = sign of correlation buffer elements (Word16) 312b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pos_max = buffer containing position of maximum correlation (Word16) 313b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber nb_track = number of tracks (Word16) 314b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ipos = buffer containing the starting position for each pulse (Word16) 315b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber step = step size in the tracks (Word16) 316b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow = pointer to Overflow flag (Flag) 317b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 318b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Outputs: 319b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber sign buffer contains the sign of correlation values 320b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dn buffer contains the sign-adjusted correlation values 321b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pos_max buffer contains the maximum correlation position 322b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ipos buffer contains the starting position of each pulse 323b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow -> 1 if the math operations called by this function result in 324b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber saturation 325b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 326b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 327b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Returns: 328b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 329b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 330b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Global Variables Used: 331b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 332b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 333b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Local Variables Needed: 334b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 335b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 336b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 337b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION DESCRIPTION 338b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 339b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber This function builds the sign vector according to dn and cn, and modifies 340b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dn to include the sign information (dn[i]=sign[i]*dn[i]). It also finds 341b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber the position of maximum of correlation in each track and the starting 342b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber position for each pulse. 343b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 344b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 345b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REQUIREMENTS 346b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 347b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 348b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 349b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 350b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REFERENCES 351b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 352b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber set_sign.c, UMTS GSM AMR speech codec, R99 - Version 3.2.0, March 2, 2001 353b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 354b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 355b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber PSEUDO-CODE 356b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 357b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Hubervoid set_sign12k2 ( 358b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 dn[], //i/o : correlation between target and h[] 359b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 cn[], //i : residual after long term prediction 360b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 sign[], //o : sign of d[n] 361b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 pos_max[], //o : position of maximum correlation 362b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 nb_track, //i : number of tracks tracks 363b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 ipos[], //o : starting position for each pulse 364b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 step //i : the step size in the tracks 365b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber) 366b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 367b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 i, j; 368b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 val, cor, k_cn, k_dn, max, max_of_all; 369b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 pos = 0; // initialization only needed to keep gcc silent 370b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 en[L_CODE]; // correlation vector 371b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 s; 372b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 373b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // The reference ETSI code uses a global flag for Overflow. However in the 374b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // actual implementation a pointer to the overflow flag is passed in. This 375b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // pointer is passed into the basic math functions called by this routine. 376b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 377b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // calculate energy for normalization of cn[] and dn[] 378b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 379b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = 256; 380b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 0; i < L_CODE; i++) 381b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 382b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = L_mac (s, cn[i], cn[i]); 383b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 384b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = Inv_sqrt (s); 385b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber k_cn = extract_h (L_shl (s, 5)); 386b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 387b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = 256; 388b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 0; i < L_CODE; i++) 389b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 390b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = L_mac (s, dn[i], dn[i]); 391b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 392b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = Inv_sqrt (s); 393b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber k_dn = extract_h (L_shl (s, 5)); 394b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 395b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 0; i < L_CODE; i++) 396b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 397b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber val = dn[i]; 398b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber cor = pv_round (L_shl (L_mac (L_mult (k_cn, cn[i]), k_dn, val), 10)); 399b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 400b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (cor >= 0) 401b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 402b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber sign[i] = 32767; // sign = +1 403b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 404b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 405b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 406b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber sign[i] = -32767; // sign = -1 407b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber cor = negate (cor); 408b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber val = negate (val); 409b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 410b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // modify dn[] according to the fixed sign 411b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dn[i] = val; 412b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber en[i] = cor; 413b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 414b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 415b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber max_of_all = -1; 416b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 0; i < nb_track; i++) 417b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 418b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber max = -1; 419b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 420b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (j = i; j < L_CODE; j += step) 421b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 422b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber cor = en[j]; 423b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber val = sub (cor, max); 424b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 425b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (val > 0) 426b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 427b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber max = cor; 428b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pos = j; 429b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 430b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 431b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // store maximum correlation position 432b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pos_max[i] = pos; 433b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber val = sub (max, max_of_all); 434b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 435b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (val > 0) 436b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 437b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber max_of_all = max; 438b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // starting position for i0 439b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ipos[0] = i; 440b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 441b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 442b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 443b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // 444b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // Set starting position of each pulse. 445b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // 446b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 447b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pos = ipos[0]; 448b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ipos[nb_track] = pos; 449b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 450b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 1; i < nb_track; i++) 451b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 452b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pos = add (pos, 1); 453b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 454b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (sub (pos, nb_track) >= 0) 455b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 456b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pos = 0; 457b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 458b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ipos[i] = pos; 459b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ipos[add(i, nb_track)] = pos; 460b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 461b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 462b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 463b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 464b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber RESOURCES USED [optional] 465b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 466b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber When the code is written for a specific target processor the 467b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber the resources used should be documented below. 468b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 469b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber HEAP MEMORY USED: x bytes 470b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 471b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber STACK MEMORY USED: x bytes 472b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 473b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CLOCK CYCLES: (cycle count equation for this function) + (variable 474b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber used to represent cycle count for each subroutine 475b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber called) 476b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber where: (cycle count variable) = cycle count for [subroutine 477b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber name] 478b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 479b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 480b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CAUTION [optional] 481b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber [State any special notes, constraints or cautions for users of this function] 482b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 483b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 484b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber*/ 485b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 486b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Hubervoid set_sign12k2( 487b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 dn[], /* i/o : correlation between target and h[] */ 488b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 cn[], /* i : residual after long term prediction */ 489b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 sign[], /* o : sign of d[n] */ 490b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 pos_max[], /* o : position of maximum correlation */ 491b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 nb_track, /* i : number of tracks tracks */ 492b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 ipos[], /* o : starting position for each pulse */ 493b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 step, /* i : the step size in the tracks */ 494b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Flag *pOverflow /* i/o: overflow flag */ 495b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber) 496b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 497b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 i, j; 498b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 val; 499b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 cor; 500b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 k_cn; 501b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 k_dn; 502b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 max; 503b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 max_of_all; 504b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 pos = 0; /* initialization only needed to keep gcc silent */ 505b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 en[L_CODE]; /* correlation vector */ 506b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 s; 507b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 t; 508b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 L_temp; 509b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *p_cn; 510b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *p_dn; 511b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *p_sign; 512b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *p_en; 513b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 514b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* calculate energy for normalization of cn[] and dn[] */ 515b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 516b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = 256; 517b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t = 256; 518b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_cn = cn; 519b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_dn = dn; /* crosscorrelation values do not have strong peaks, so 520b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber scaling applied in cor_h_x (sf=2) guaranteed that the 521b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber mac of the energy for this vector will not overflow */ 522b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 523b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = L_CODE; i != 0; i--) 524b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 525b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber val = *(p_cn++); 526b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = L_mac(s, val, val, pOverflow); 527b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber val = *(p_dn++); 528b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t += ((Word32) val * val) << 1; 529b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 530b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = Inv_sqrt(s, pOverflow); 531b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber k_cn = (Word16)((L_shl(s, 5, pOverflow)) >> 16); 532b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 533b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber t = Inv_sqrt(t, pOverflow); 534b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber k_dn = (Word16)(t >> 11); 535b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 536b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_cn = &cn[L_CODE-1]; 537b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_sign = &sign[L_CODE-1]; 538b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_en = &en[L_CODE-1]; 539b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 540b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = L_CODE - 1; i >= 0; i--) 541b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 542b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_temp = ((Word32)k_cn * *(p_cn--)) << 1; 543b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber val = dn[i]; 544b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = L_mac(L_temp, k_dn, val, pOverflow); 545b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_temp = L_shl(s, 10, pOverflow); 546b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber cor = pv_round(L_temp, pOverflow); 547b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 548b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (cor >= 0) 549b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 550b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *(p_sign--) = 32767; /* sign = +1 */ 551b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 552b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 553b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 554b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *(p_sign--) = -32767; /* sign = -1 */ 555e55147f462e04d41bff7ead6e9ea61a5b83bda4bMartin Storsjo cor = negate(cor); 556b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 557b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* modify dn[] according to the fixed sign */ 558e55147f462e04d41bff7ead6e9ea61a5b83bda4bMartin Storsjo dn[i] = negate(val); 559b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 560b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 561b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *(p_en--) = cor; 562b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 563b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 564b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber max_of_all = -1; 565b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 0; i < nb_track; i++) 566b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 567b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber max = -1; 568b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 569b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (j = i; j < L_CODE; j += step) 570b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 571b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber cor = en[j]; 572b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (cor > max) 573b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 574b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber max = cor; 575b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pos = j; 576b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 577b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 578b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* store maximum correlation position */ 579b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pos_max[i] = pos; 580b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (max > max_of_all) 581b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 582b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber max_of_all = max; 583b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* starting position for i0 */ 584b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ipos[0] = i; 585b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 586b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 587b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 588b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /*----------------------------------------------------------------* 589b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * Set starting position of each pulse. * 590b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *----------------------------------------------------------------*/ 591b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 592b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pos = ipos[0]; 593b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ipos[nb_track] = pos; 594b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 595b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 1; i < nb_track; i++) 596b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 597b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pos++; 598b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 599b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (pos >= nb_track) 600b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 601b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pos = 0; 602b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 603b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ipos[ i] = pos; 604b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ipos[ i + nb_track] = pos; 605b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 606b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 607b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return; 608b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 609b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 610