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/c2_11pf.c 35b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Functions: 36b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber code_2i40_11bits 37b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber search_2i40 38b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber build_code 39b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 40b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Date: 01/28/2002 41b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 42b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 43b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REVISION HISTORY 44b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 45b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Modified to pass overflow flag through to basic math function. 46b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber The flag is passed back to the calling function by pointer reference. 47b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 48b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Fixed tabs prior to optimization to make diff'ing easier. 49b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Optimized search_2i40() to reduce clock cycle usage. 50b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 51b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Optimized build_code() to reduce clock cycle usage. 52b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 53b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Changed function name to pv_round to avoid conflict with 54b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber round function in C standard library. 55b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 56b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Added casting to eliminate warnings 57b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 58b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Replaced "int" and/or "char" with OSCL defined types. 59b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 60b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: 61b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 62b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 63b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber MODULE DESCRIPTION 64b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 65b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ************************************************************************* 66b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * 67b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * FUNCTION: code_2i40_11bits() 68b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * 69b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * PURPOSE: Searches a 11 bit algebraic codebook containing 2 pulses 70b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * in a frame of 40 samples. 71b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * 72b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * DESCRIPTION: 73b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * The code length is 40, containing 2 nonzero pulses: i0...i1. 74b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * All pulses can have two possible amplitudes: +1 or -1. 75b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * Pulse i0 can have 2x8=16 possible positions, pulse i1 can have 76b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * 4x8=32 positions. 77b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * 78b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * i0 : 1, 6, 11, 16, 21, 26, 31, 36. 79b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * 3, 8, 13, 18, 23, 28, 33, 38. 80b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * i1 : 0, 5, 10, 15, 20, 25, 30, 35. 81b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * 1, 6, 11, 16, 21, 26, 31, 36. 82b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * 2, 7, 12, 17, 22, 27, 32, 37. 83b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * 4, 9, 14, 19, 24, 29, 34, 39. 84b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * 85b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ************************************************************************* 86b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 87b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber*/ 88b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 89b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 90b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; INCLUDES 91b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 92b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "c2_11pf.h" 93b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "typedef.h" 94b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "basic_op.h" 95b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "inv_sqrt.h" 96b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "cnst.h" 97b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "cor_h.h" 98b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "set_sign.h" 99b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 100b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 101b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; MACROS 102b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; Define module specific macros here 103b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 104b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 105b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 106b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; DEFINES 107b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; Include all pre-processor statements here. Include conditional 108b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; compile variables also. 109b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 110b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#define NB_PULSE 2 111b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 112b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#define _1_2 (Word16)(32768L/2) 113b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#define _1_4 (Word16)(32768L/4) 114b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#define _1_8 (Word16)(32768L/8) 115b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#define _1_16 (Word16)(32768L/16) 116b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 117b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 118b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; LOCAL FUNCTION DEFINITIONS 119b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; Function Prototype declaration 120b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 121b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huberstatic void search_2i40( 122b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 dn[], /* i : correlation between target and h[] */ 123b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 rr[][L_CODE],/* i : matrix of autocorrelation */ 124b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 codvec[], /* o : algebraic codebook vector */ 125b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Flag * pOverflow 126b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber); 127b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 128b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huberstatic Word16 build_code( 129b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 codvec[], /* i : algebraic codebook vector */ 130b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 dn_sign[], /* i : sign of dn[] */ 131b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 cod[], /* o : algebraic (fixed) codebook excitation */ 132b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 h[], /* i : impulse response of weighted synthesis filter */ 133b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 y[], /* o : filtered fixed codebook excitation */ 134b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 sign[], /* o : sign of 2 pulses */ 135b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Flag * pOverflow 136b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber); 137b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 138b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 139b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; LOCAL VARIABLE DEFINITIONS 140b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; Variable declaration - defined here and used outside this module 141b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 142b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 143b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huberconst Word16 startPos1[2] = {1, 3}; 144b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huberconst Word16 startPos2[4] = {0, 1, 2, 4}; 145b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 146b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/* 147b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 148b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION NAME: code_2i40_11bits 149b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 150b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber INPUT AND OUTPUT DEFINITIONS 151b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 152b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Inputs: 153b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber x, target vector, array of type Word16 154b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber h, impulse response of weighted synthesis filter, array of type Word16 155b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber T0, Pitch lag, variable of type Word16 156b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pitch_sharp, Last quantized pitch gain, variable of type Word16 157b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 158b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Outputs: 159b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber code[], Innovative codebook, array of type Word16 160b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber y[], filtered fixed codebook excitation, array of type Word16 161b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber sign, Signs of 2 pulses, pointer of type Word16 * 162b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow Flag set when overflow occurs, pointer of type Flag * 163b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 164b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Returns: 165b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber index 166b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 167b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Global Variables Used: 168b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 169b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 170b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Local Variables Needed: 171b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 172b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 173b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 174b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION DESCRIPTION 175b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 176b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Searches a 11 bit algebraic codebook containing 2 pulses 177b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber in a frame of 40 samples. 178b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 179b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber The code length is 40, containing 2 nonzero pulses: i0...i1. 180b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber All pulses can have two possible amplitudes: +1 or -1. 181b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Pulse i0 can have 2x8=16 possible positions, pulse i1 can have 182b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 4x8=32 positions. 183b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 184b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber i0 : 1, 6, 11, 16, 21, 26, 31, 36. 185b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 3, 8, 13, 18, 23, 28, 33, 38. 186b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber i1 : 0, 5, 10, 15, 20, 25, 30, 35. 187b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1, 6, 11, 16, 21, 26, 31, 36. 188b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 2, 7, 12, 17, 22, 27, 32, 37. 189b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 4, 9, 14, 19, 24, 29, 34, 39. 190b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 191b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 192b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REQUIREMENTS 193b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 194b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 195b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 196b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 197b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REFERENCES 198b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 199b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber c2_11pf.c, UMTS GSM AMR speech codec, R99 - Version 3.2.0, March 2, 2001 200b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 201b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 202b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber PSEUDO-CODE 203b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 204b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 205b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 206b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber RESOURCES USED [optional] 207b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 208b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber When the code is written for a specific target processor the 209b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber the resources used should be documented below. 210b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 211b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber HEAP MEMORY USED: x bytes 212b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 213b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber STACK MEMORY USED: x bytes 214b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 215b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CLOCK CYCLES: (cycle count equation for this function) + (variable 216b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber used to represent cycle count for each subroutine 217b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber called) 218b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber where: (cycle count variable) = cycle count for [subroutine 219b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber name] 220b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 221b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 222b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CAUTION [optional] 223b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber [State any special notes, constraints or cautions for users of this function] 224b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 225b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 226b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber*/ 227b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas HuberWord16 code_2i40_11bits( 228b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 x[], /* i : target vector */ 229b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 h[], /* i : impulse response of weighted synthesis filter */ 230b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* h[-L_subfr..-1] must be set to zero. */ 231b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 T0, /* i : Pitch lag */ 232b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 pitch_sharp, /* i : Last quantized pitch gain */ 233b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 code[], /* o : Innovative codebook */ 234b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 y[], /* o : filtered fixed codebook excitation */ 235b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 * sign, /* o : Signs of 2 pulses */ 236b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Flag * pOverflow /* o : Flag set when overflow occurs */ 237b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber) 238b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 239b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 codvec[NB_PULSE]; 240b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 dn[L_CODE]; 241b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 dn2[L_CODE]; 242b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 dn_sign[L_CODE]; 243b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 244b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 rr[L_CODE][L_CODE]; 245b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 246b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 i; 247b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 index; 248b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 sharp; 249b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 tempWord; 250b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 251b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber sharp = pitch_sharp << 1; 252b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 253b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (T0 < L_CODE) 254b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 255b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = T0; i < L_CODE; i++) 256b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 257b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tempWord = 258b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber mult( 259b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber h[i - T0], 260b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber sharp, 261b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow); 262b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 263b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber h[i] = 264b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber add( 265b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber h[i], 266b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tempWord, 267b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow); 268b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 269b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 270b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 271b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 272b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber cor_h_x( 273b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber h, 274b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber x, 275b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dn, 276b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1, 277b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow); 278b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 279b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber set_sign( 280b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dn, 281b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dn_sign, 282b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dn2, 283b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 8); /* dn2[] not used in this codebook search */ 284b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 285b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber cor_h( 286b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber h, 287b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dn_sign, 288b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber rr, 289b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow); 290b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 291b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber search_2i40( 292b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dn, 293b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber rr, 294b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber codvec, 295b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow); 296b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 297b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* function result */ 298b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 299b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber index = 300b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber build_code( 301b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber codvec, 302b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dn_sign, 303b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber code, 304b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber h, 305b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber y, 306b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber sign, 307b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow); 308b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 309b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* 310b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * Compute innovation vector gain. 311b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * Include fixed-gain pitch contribution into code[]. 312b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber */ 313b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 314b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (T0 < L_CODE) 315b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 316b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = T0; i < L_CODE; i++) 317b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 318b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tempWord = 319b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber mult( 320b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber code[i - T0], 321b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber sharp, 322b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow); 323b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 324b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber code[i] = 325b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber add( 326b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber code[i], 327b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tempWord, 328b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow); 329b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 330b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 331b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 332b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return index; 333b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 334b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 335b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/****************************************************************************/ 336b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 337b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 338b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/* 339b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 340b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION NAME: search_2i40 341b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 342b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber INPUT AND OUTPUT DEFINITIONS 343b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 344b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Inputs: 345b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dn, correlation between target and h[], array of type Word16 346b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber rr, matrix of autocorrelation, double-array of type Word16 347b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 348b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Outputs: 349b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber codvec[], algebraic codebook vector, array of type Word16 350b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow, Flag set when overflow occurs, pointer of type Flag * 351b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 352b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Returns: 353b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 354b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 355b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Global Variables Used: 356b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 357b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 358b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Local Variables Needed: 359b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 360b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 361b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 362b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION DESCRIPTION 363b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 364b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Search the best codevector; determine positions of the 2 pulses 365b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber in the 40-sample frame. 366b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 367b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 368b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REQUIREMENTS 369b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 370b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 371b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 372b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 373b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REFERENCES 374b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 375b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber c2_11pf.c, UMTS GSM AMR speech codec, R99 - Version 3.2.0, March 2, 2001 376b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 377b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 378b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber PSEUDO-CODE 379b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 380b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 381b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 382b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber RESOURCES USED [optional] 383b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 384b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber When the code is written for a specific target processor the 385b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber the resources used should be documented below. 386b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 387b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber HEAP MEMORY USED: x bytes 388b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 389b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber STACK MEMORY USED: x bytes 390b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 391b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CLOCK CYCLES: (cycle count equation for this function) + (variable 392b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber used to represent cycle count for each subroutine 393b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber called) 394b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber where: (cycle count variable) = cycle count for [subroutine 395b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber name] 396b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 397b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 398b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CAUTION [optional] 399b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber [State any special notes, constraints or cautions for users of this function] 400b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 401b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 402b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber*/ 403b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 404b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huberstatic void search_2i40( 405b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 dn[], /* i : correlation between target and h[] */ 406b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 rr[][L_CODE], /* i : matrix of autocorrelation */ 407b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 codvec[], /* o : algebraic codebook vector */ 408b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Flag * pOverflow /* o : Flag set when overflow occurs */ 409b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber) 410b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 411b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 i0; 412b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 i1; 413b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 ix = 0; /* initialization only needed to keep gcc silent */ 414b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 track1; 415b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 track2; 416b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 ipos[NB_PULSE]; 417b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 418b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 psk; 419b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 ps0; 420b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 ps1; 421b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 sq; 422b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 sq1; 423b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 424b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 alpk; 425b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 alp; 426b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 alp_16; 427b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 428b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 s; 429b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 alp0; 430b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 alp1; 431b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 432b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 i; 433b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *p_codvec = &codvec[0]; 434b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 435b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber psk = -1; 436b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber alpk = 1; 437b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 438b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 0; i < NB_PULSE; i++) 439b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 440b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *(p_codvec++) = i; 441b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 442b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 443b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /*------------------------------------------------------------------* 444b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * main loop: try 2x4 tracks. * 445b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *------------------------------------------------------------------*/ 446b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 447b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (track1 = 0; track1 < 2; track1++) 448b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 449b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (track2 = 0; track2 < 4; track2++) 450b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 451b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* fix starting position */ 452b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ipos[0] = startPos1[track1]; 453b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ipos[1] = startPos2[track2]; 454b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 455b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /*----------------------------------------------------------------* 456b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * i0 loop: try 8 positions. * 457b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *----------------------------------------------------------------*/ 458b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i0 = ipos[0]; i0 < L_CODE; i0 += STEP) 459b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 460b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ps0 = dn[i0]; 461b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 462b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* alp0 = L_mult(rr[i0][i0], _1_4, pOverflow); */ 463b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber alp0 = (Word32) rr[i0][i0] << 14; 464b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 465b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /*-------------------------------------------------------------* 466b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * i1 loop: 8 positions. * 467b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *-------------------------------------------------------------*/ 468b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 469b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber sq = -1; 470b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber alp = 1; 471b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ix = ipos[1]; 472b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 473b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /*---------------------------------------------------------------* 474b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * These index have low complexity address computation because * 475b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * they are, in fact, pointers with fixed increment. For example,* 476b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * "rr[i0][i2]" is a pointer initialized to "&rr[i0][ipos[2]]" * 477b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * and incremented by "STEP". * 478b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *---------------------------------------------------------------*/ 479b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 480b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i1 = ipos[1]; i1 < L_CODE; i1 += STEP) 481b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 482b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* idx increment = STEP */ 483b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ps1 = add(ps0, dn[i1], pOverflow); 484b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 485b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* alp1 = alp0 + rr[i0][i1] + 1/2*rr[i1][i1]; */ 486b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 487b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* idx incr = STEP */ 488b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* alp1 = L_mac(alp0, rr[i1][i1], _1_4, pOverflow); */ 489b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber alp1 = alp0 + ((Word32) rr[i1][i1] << 14); 490b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 491b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* idx incr = STEP */ 492b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* alp1 = L_mac(alp1, rr[i0][i1], _1_2, pOverflow); */ 493b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber alp1 += (Word32) rr[i0][i1] << 15; 494b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 495b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* sq1 = mult(ps1, ps1, pOverflow); */ 496b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber sq1 = (Word16)(((Word32) ps1 * ps1) >> 15); 497b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 498b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* alp_16 = pv_round(alp1, pOverflow); */ 499b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber alp_16 = (Word16)((alp1 + (Word32) 0x00008000L) >> 16); 500b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 501b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* s = L_mult(alp, sq1, pOverflow); */ 502b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = ((Word32) alp * sq1) << 1; 503b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 504b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* s =L_msu(s, sq, alp_16, pOverflow); */ 505b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s -= (((Word32) sq * alp_16) << 1); 506b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 507b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (s > 0) 508b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 509b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber sq = sq1; 510b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber alp = alp_16; 511b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber ix = i1; 512b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 513b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 514b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } /* for (i1 = ipos[1]; i1 < L_CODE; i1 += STEP) */ 515b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 516b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* memorize codevector if this one is better than the last one. */ 517b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 518b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* s = L_mult(alpk, sq, pOverflow); */ 519b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = ((Word32) alpk * sq) << 1; 520b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 521b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* s = L_msu(s, psk, alp, pOverflow); */ 522b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s -= (((Word32) psk * alp) << 1); 523b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 524b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (s > 0) 525b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 526b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber psk = sq; 527b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber alpk = alp; 528b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p_codvec = &codvec[0]; 529b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 530b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *(p_codvec++) = i0; 531b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *(p_codvec) = ix; 532b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 533b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 534b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } /* for (i0 = ipos[0]; i0 < L_CODE; i0 += STEP) */ 535b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 536b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } /* for (track2 = 0; track2 < 4; track2++) */ 537b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 538b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } /* for (track1 = 0; track1 < 2; track1++) */ 539b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 540b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return; 541b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 542b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} /* search_2i40 */ 543b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 544b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/****************************************************************************/ 545b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 546b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 547b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/* 548b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 549b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION NAME: build_code 550b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 551b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber INPUT AND OUTPUT DEFINITIONS 552b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 553b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Inputs: 554b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber codvec, position of pulses, array of type Word16 555b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber dn_sign, sign of pulses, array of type Word16 556b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber h, impulse response of weighted synthesis filter, Word16 array 557b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 558b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Outputs: 559b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 560b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber cod, innovative code vector, array of type Word16 561b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber y[], filtered innovative code, array of type Word16 562b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber sign[], sign of 2 pulses, array of type Word16 563b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow, Flag set when overflow occurs, pointer of type Flag * 564b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 565b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Returns: 566b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 567b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Global Variables Used: 568b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 569b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 570b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Local Variables Needed: 571b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 572b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 573b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 574b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION DESCRIPTION 575b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 576b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Builds the codeword, the filtered codeword and index of the 577b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber codevector, based on the signs and positions of 2 pulses. 578b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 579b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 580b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REQUIREMENTS 581b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 582b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 583b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 584b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 585b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REFERENCES 586b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 587b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber c2_11pf.c, UMTS GSM AMR speech codec, R99 - Version 3.2.0, March 2, 2001 588b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 589b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 590b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber PSEUDO-CODE 591b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 592b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 593b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber RESOURCES USED [optional] 594b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 595b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber When the code is written for a specific target processor the 596b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber the resources used should be documented below. 597b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 598b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber HEAP MEMORY USED: x bytes 599b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 600b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber STACK MEMORY USED: x bytes 601b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 602b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CLOCK CYCLES: (cycle count equation for this function) + (variable 603b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber used to represent cycle count for each subroutine 604b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber called) 605b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber where: (cycle count variable) = cycle count for [subroutine 606b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber name] 607b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 608b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 609b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CAUTION [optional] 610b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber [State any special notes, constraints or cautions for users of this function] 611b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 612b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 613b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber*/ 614b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huberstatic Word16 build_code( 615b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 codvec[], /* i : position of pulses */ 616b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 dn_sign[], /* i : sign of pulses */ 617b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 cod[], /* o : innovative code vector */ 618b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 h[], /* i : impulse response of weighted synthesis filter */ 619b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 y[], /* o : filtered innovative code */ 620b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 sign[], /* o : sign of 2 pulses */ 621b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Flag * pOverflow /* o : Flag set when overflow occurs */ 622b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber) 623b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 624b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 i; 625b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 j; 626b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 k; 627b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 track; 628b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 index; 629b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 _sign[NB_PULSE]; 630b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 indx; 631b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 rsign; 632b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 tempWord; 633b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 634b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *p0; 635b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 *p1; 636b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 637b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word32 s; 638b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 639b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 0; i < L_CODE; i++) 640b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 641b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber cod[i] = 0; 642b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 643b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 644b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber indx = 0; 645b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber rsign = 0; 646b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 647b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (k = 0; k < NB_PULSE; k++) 648b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 649b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber i = codvec[k]; /* read pulse position */ 650b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber j = dn_sign[i]; /* read sign */ 651b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 652b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* index = pos/5 */ 653b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* index = mult(i, 6554, pOverflow); */ 654b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber index = (Word16)(((Word32) i * 6554) >> 15); 655b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 656b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* track = pos%5 */ 657b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* tempWord = 658b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_mult( 659b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber index, 660b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 5, 661b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow); */ 662b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tempWord = ((Word32) index * 5) << 1; 663b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 664b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* tempWord = 665b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_shr( 666b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tempWord, 667b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1, 668b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow); */ 669b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tempWord >>= 1; 670b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 671b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 672b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* track = 673b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber sub( 674b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber i, 675b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tempWord, 676b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow); */ 677b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber track = i - tempWord; 678b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 679b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tempWord = track; 680b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 681b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (tempWord == 0) 682b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 683b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber track = 1; 684b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 685b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* index = 686b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber shl( 687b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber index, 688b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 6, 689b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow); */ 690b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber index <<= 6; 691b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 692b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else if (track == 1) 693b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 694b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tempWord = k; 695b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 696b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (tempWord == 0) 697b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 698b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber track = 0; 699b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* index = 700b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber shl( 701b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber index, 702b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1, 703b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow); */ 704b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber index <<= 1; 705b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 706b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 707b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 708b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber track = 1; 709b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 710b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* tempWord = 711b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber shl( 712b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber index, 713b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 6, 714b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow); */ 715b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tempWord = index << 6; 716b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 717b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* index = 718b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber add( 719b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tempWord, 720b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 16, 721b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow); */ 722b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber index = tempWord + 16; 723b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 724b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 725b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else if (track == 2) 726b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 727b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber track = 1; 728b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 729b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* tempWord = 730b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber shl( 731b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber index, 732b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 6, 733b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow); */ 734b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tempWord = index << 6; 735b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 736b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* index = 737b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber add( 738b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tempWord, 739b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 32, 740b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow); */ 741b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber index = tempWord + 32; 742b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 743b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else if (track == 3) 744b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 745b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber track = 0; 746b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 747b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* tempWord = 748b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber shl( 749b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber index, 750b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1, 751b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow); */ 752b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tempWord = index << 1; 753b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 754b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* index = 755b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber add( 756b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tempWord, 757b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1, 758b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow); */ 759b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber index = tempWord + 1; 760b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 761b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else if (track == 4) 762b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 763b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber track = 1; 764b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 765b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* tempWord = 766b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber shl( 767b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber index, 768b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 6, 769b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow); */ 770b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tempWord = index << 6; 771b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 772b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* index = 773b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber add( 774b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tempWord, 775b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 48, 776b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow); */ 777b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber index = tempWord + 48; 778b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 779b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 780b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (j > 0) 781b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 782b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber cod[i] = 8191; 783b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber _sign[k] = 32767; 784b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 785b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tempWord = 786b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber shl( 787b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1, 788b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber track, 789b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow); 790b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 791b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber rsign = 792b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber add( 793b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber rsign, 794b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tempWord, 795b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow); 796b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 797b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 798b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 799b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber cod[i] = -8192; 800b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber _sign[k] = (Word16) - 32768L; 801b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 802b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 803b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber indx = 804b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber add( 805b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber indx, 806b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber index, 807b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow); 808b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 809b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *sign = rsign; 810b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 811b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p0 = h - codvec[0]; 812b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber p1 = h - codvec[1]; 813b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 814b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber for (i = 0; i < L_CODE; i++) 815b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 816b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = 0; 817b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 818b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = 819b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_mac( 820b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s, 821b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *p0++, 822b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber _sign[0], 823b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow); 824b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 825b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s = 826b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber L_mac( 827b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s, 828b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber *p1++, 829b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber _sign[1], 830b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow); 831b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 832b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber y[i] = 833b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pv_round( 834b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber s, 835b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow); 836b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 837b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 838b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return indx; 839b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 840b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 841b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 842