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/enc_lag3.c 35b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Functions: 36b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 37b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Date: 01/28/2002 38b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 39b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 40b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REVISION HISTORY 41b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 42b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: Replaced "int" and/or "char" with OSCL defined types. 43b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 44b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Description: 45b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 46b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 47b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber*/ 48b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 49b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 50b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; INCLUDES 51b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 52b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "enc_lag3.h" 53b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "typedef.h" 54b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "basic_op.h" 55b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber#include "cnst.h" 56b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 57b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 58b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; MACROS 59b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; Define module specific macros here 60b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 61b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 62b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 63b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; DEFINES 64b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; Include all pre-processor statements here. Include conditional 65b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; compile variables also. 66b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 67b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 68b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 69b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 70b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; LOCAL FUNCTION DEFINITIONS 71b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; Function Prototype declaration 72b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 73b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 74b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 75b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/*---------------------------------------------------------------------------- 76b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; LOCAL VARIABLE DEFINITIONS 77b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber; Variable declaration - defined here and used outside this module 78b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber----------------------------------------------------------------------------*/ 79b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 80b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber/* 81b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 82b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION NAME: enc_lag3 83b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 84b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber INPUT AND OUTPUT DEFINITIONS 85b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 86b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Inputs: 87b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber T0 = Pitch delay of type Word16 88b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber T0_frac = Fractional pitch delay of type Word16 89b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber T0_prev = Integer pitch delay of last subframe of type Word16 90b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber T0_min = minimum of search range of type Word16 91b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber T0_max = maximum of search range of type Word16 92b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber delta_flag = Flag for 1st (or 3rd) subframe of type Word16 93b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber flag4 = Flag for encoding with 4 bits of type Word16 94b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow = pointer indicating overflow of type Flag 95b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 96b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Outputs: 97b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber pOverflow = 1 if there is an overflow else it is zero. 98b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 99b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Returns: 100b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 101b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 102b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Global Variables Used: 103b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 104b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 105b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Local Variables Needed: 106b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 107b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 108b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 109b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber FUNCTION DESCRIPTION 110b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 111b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber This function implements the encoding of fractional pitch lag with 112b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 1/3 resolution. 113b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 114b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * FUNCTION: Enc_lag3 115b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * 116b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * PURPOSE: Encoding of fractional pitch lag with 1/3 resolution. 117b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * 118b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * DESCRIPTION: 119b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * First and third subframes: 120b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * -------------------------- 121b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * The pitch range is divided as follows: 122b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * 19 1/3 to 84 2/3 resolution 1/3 123b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * 85 to 143 resolution 1 124b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * 125b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * The period is encoded with 8 bits. 126b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * For the range with fractions: 127b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * index = (T-19)*3 + frac - 1; 128b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * where T=[19..85] and frac=[-1,0,1] 129b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * and for the integer only range 130b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * index = (T - 85) + 197; where T=[86..143] 131b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * 132b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * Second and fourth subframes: 133b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * ---------------------------- 134b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * For the 2nd and 4th subframes a resolution of 1/3 is always used, 135b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * and the search range is relative to the lag in previous subframe. 136b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * If t0 is the lag in the previous subframe then 137b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * t_min=t0-5 and t_max=t0+4 and the range is given by 138b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * t_min - 2/3 to t_max + 2/3 139b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * 140b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * The period in the 2nd (and 4th) subframe is encoded with 5 bits: 141b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * index = (T-(t_min-1))*3 + frac - 1; 142b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber * where T=[t_min-1..t_max+1] 143b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 144b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 145b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REQUIREMENTS 146b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 147b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber None 148b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 149b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 150b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber REFERENCES 151b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 152b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber enc_lag3.c, UMTS GSM AMR speech codec, R99 - Version 3.2.0, March 2, 2001 153b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 154b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 155b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber PSEUDO-CODE 156b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 157b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 index, i, tmp_ind, uplag; 158b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 tmp_lag; 159b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 160b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (delta_flag == 0) 161b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { // if 1st or 3rd subframe 162b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 163b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // encode pitch delay (with fraction) 164b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 165b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (sub (T0, 85) <= 0) 166b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 167b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // index = T0*3 - 58 + T0_frac 168b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber i = add (add (T0, T0), T0); 169b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber index = add (sub (i, 58), T0_frac); 170b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 171b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 172b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 173b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber index = add (T0, 112); 174b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 175b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 176b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 177b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { // if second or fourth subframe 178b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (flag4 == 0) { 179b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 180b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // 'normal' encoding: either with 5 or 6 bit resolution 181b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 182b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // index = 3*(T0 - T0_min) + 2 + T0_frac 183b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber i = sub (T0, T0_min); 184b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber i = add (add (i, i), i); 185b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber index = add (add (i, 2), T0_frac); 186b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 187b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else { 188b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 189b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber // encoding with 4 bit resolution 190b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 191b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tmp_lag = T0_prev; 192b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 193b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if ( sub( sub(tmp_lag, T0_min), 5) > 0) 194b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tmp_lag = add (T0_min, 5); 195b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if ( sub( sub(T0_max, tmp_lag), 4) > 0) 196b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tmp_lag = sub (T0_max, 4); 197b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 198b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber uplag = add (add (add (T0, T0), T0), T0_frac); 199b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 200b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber i = sub (tmp_lag, 2); 201b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tmp_ind = add (add (i, i), i); 202b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 203b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (sub (tmp_ind, uplag) >= 0) { 204b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber index = add (sub (T0, tmp_lag), 5); 205b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 206b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else { 207b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 208b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber i = add (tmp_lag, 1); 209b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber i = add (add (i, i), i); 210b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 211b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (sub (i, uplag) > 0) { 212b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 213b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber index = add ( sub (uplag, tmp_ind), 3); 214b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 215b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else { 216b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 217b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber index = add (sub (T0, tmp_lag), 11); 218b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 219b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 220b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 221b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } // end if (encoding with 4 bit resolution) 222b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } // end if (second of fourth subframe) 223b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 224b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return index; 225b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 226b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 227b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 228b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber RESOURCES USED [optional] 229b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 230b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber When the code is written for a specific target processor the 231b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber the resources used should be documented below. 232b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 233b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber HEAP MEMORY USED: x bytes 234b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 235b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber STACK MEMORY USED: x bytes 236b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 237b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CLOCK CYCLES: (cycle count equation for this function) + (variable 238b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber used to represent cycle count for each subroutine 239b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber called) 240b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber where: (cycle count variable) = cycle count for [subroutine 241b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber name] 242b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 243b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 244b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber CAUTION [optional] 245b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber [State any special notes, constraints or cautions for users of this function] 246b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 247b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber------------------------------------------------------------------------------ 248b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber*/ 249b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 250b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 251b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas HuberWord16 Enc_lag3( /* o : Return index of encoding */ 252b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 T0, /* i : Pitch delay */ 253b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 T0_frac, /* i : Fractional pitch delay */ 254b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 T0_prev, /* i : Integer pitch delay of last subframe */ 255b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 T0_min, /* i : minimum of search range */ 256b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 T0_max, /* i : maximum of search range */ 257b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 delta_flag, /* i : Flag for 1st (or 3rd) subframe */ 258b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 flag4, /* i : Flag for encoding with 4 bits */ 259b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Flag *pOverflow 260b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber) 261b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber{ 262b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 index, i, tmp_ind, uplag; 263b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 tmp_lag; 264b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 temp1; 265b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber Word16 temp2; 266b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 267b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 268b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 269b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (delta_flag == 0) 270b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { /* if 1st or 3rd subframe */ 271b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 272b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* encode pitch delay (with fraction) */ 273b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber temp1 = sub(T0, 85, pOverflow); 274b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (temp1 <= 0) 275b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 276b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* index = T0*3 - 58 + T0_frac */ 277b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber temp2 = add(T0, T0, pOverflow); 278b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber i = add(temp2, T0, pOverflow); 279b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber temp2 = sub(i, 58, pOverflow); 280b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber index = add(temp2, T0_frac, pOverflow); 281b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 282b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 283b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 284b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber index = add(T0, 112, pOverflow); 285b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 286b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 287b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 288b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { /* if second or fourth subframe */ 289b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (flag4 == 0) 290b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 291b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 292b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* 'normal' encoding: either with 5 or 6 bit resolution */ 293b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 294b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* index = 3*(T0 - T0_min) + 2 + T0_frac */ 295b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber i = sub(T0, T0_min, pOverflow); 296b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber temp2 = add(i, i, pOverflow); 297b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber i = add(temp2, i, pOverflow); 298b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber temp2 = add(i, 2, pOverflow); 299b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber index = add(temp2, T0_frac, pOverflow); 300b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 301b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 302b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 303b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 304b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber /* encoding with 4 bit resolution */ 305b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 306b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tmp_lag = T0_prev; 307b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber temp1 = sub(tmp_lag, T0_min, pOverflow); 308b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber temp2 = sub(temp1, 5, pOverflow); 309b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (temp2 > 0) 310b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tmp_lag = add(T0_min, 5, pOverflow); 311b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber temp1 = sub(T0_max, tmp_lag, pOverflow); 312b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber temp2 = sub(temp1, 4, pOverflow); 313b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (temp2 > 0) 314b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tmp_lag = sub(T0_max, 4, pOverflow); 315b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 316b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber temp1 = add(T0, T0, pOverflow); 317b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber temp2 = add(temp1, T0, pOverflow); 318b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber uplag = add(temp2, T0_frac, pOverflow); 319b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 320b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber i = sub(tmp_lag, 2, pOverflow); 321b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber temp1 = add(i, i, pOverflow); 322b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber tmp_ind = add(temp1, i, pOverflow); 323b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 324b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber temp1 = sub(tmp_ind, uplag, pOverflow); 325b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (temp1 >= 0) 326b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 327b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber temp1 = sub(T0, tmp_lag, pOverflow); 328b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber index = add(temp1, 5, pOverflow); 329b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 330b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 331b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 332b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 333b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber i = add(tmp_lag, 1, pOverflow); 334b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber temp1 = add(i, i, pOverflow); 335b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber i = add(temp1, i, pOverflow); 336b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 337b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber if (sub(i, uplag, pOverflow) > 0) 338b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 339b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber temp1 = sub(uplag, tmp_ind, pOverflow); 340b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber index = add(temp1, 3, pOverflow); 341b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 342b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber else 343b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber { 344b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber temp1 = sub(T0, tmp_lag, pOverflow); 345b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber index = add(temp1, 11, pOverflow); 346b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 347b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } 348b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 349b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } /* end if (encoding with 4 bit resolution) */ 350b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber } /* end if (second of fourth subframe) */ 351b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 352b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber return index; 353b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber} 354b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 355b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 356b841f14f8e51f2365945281fbfa54ef6a1b1b5a6Andreas Huber 357