1e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard/* 2e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard ** Copyright 2003-2010, VisualOn, Inc. 3e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard ** 4e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard ** Licensed under the Apache License, Version 2.0 (the "License"); 5e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard ** you may not use this file except in compliance with the License. 6e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard ** You may obtain a copy of the License at 7e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard ** 8e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard ** http://www.apache.org/licenses/LICENSE-2.0 9e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard ** 10e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard ** Unless required by applicable law or agreed to in writing, software 11e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard ** distributed under the License is distributed on an "AS IS" BASIS, 12e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard ** WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 13e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard ** See the License for the specific language governing permissions and 14e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard ** limitations under the License. 15e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard */ 16e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 17e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard/*********************************************************************** 18e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard* File: g_pitch.c * 19e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard* * 20e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard* Description:Compute the gain of pitch. Result in Q12 * 21e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard* if(gain < 0) gain = 0 * 22e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard* if(gain > 1.2) gain = 1.2 * 23e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard************************************************************************/ 24e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 25e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard#include "typedef.h" 26e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard#include "basic_op.h" 27e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard#include "math_op.h" 28e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 29e2e838afcf03e603a41a0455846eaf9614537c16Mans RullgardWord16 G_pitch( /* (o) Q14 : Gain of pitch lag saturated to 1.2 */ 30e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard Word16 xn[], /* (i) : Pitch target. */ 31e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard Word16 y1[], /* (i) : filtered adaptive codebook. */ 32e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard Word16 g_coeff[], /* : Correlations need for gain quantization. */ 33e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard Word16 L_subfr /* : Length of subframe. */ 34e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard ) 35e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard{ 36e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard Word32 i; 37e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard Word16 xy, yy, exp_xy, exp_yy, gain; 38e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard /* Compute scalar product <y1[],y1[]> */ 39e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard#ifdef ASM_OPT /* asm optimization branch */ 40e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard /* Compute scalar product <xn[],y1[]> */ 41e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard xy = extract_h(Dot_product12_asm(xn, y1, L_subfr, &exp_xy)); 42e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard yy = extract_h(Dot_product12_asm(y1, y1, L_subfr, &exp_yy)); 43e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 44e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard#else 45e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard /* Compute scalar product <xn[],y1[]> */ 46e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard xy = extract_h(Dot_product12(xn, y1, L_subfr, &exp_xy)); 47e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard yy = extract_h(Dot_product12(y1, y1, L_subfr, &exp_yy)); 48e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 49e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard#endif 50e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 51b676a05348e4c516fa8b57e33b10548e6142c3f8Mans Rullgard g_coeff[0] = yy; 52b676a05348e4c516fa8b57e33b10548e6142c3f8Mans Rullgard g_coeff[1] = exp_yy; 53b676a05348e4c516fa8b57e33b10548e6142c3f8Mans Rullgard g_coeff[2] = xy; 54b676a05348e4c516fa8b57e33b10548e6142c3f8Mans Rullgard g_coeff[3] = exp_xy; 55e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 56e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard /* If (xy < 0) gain = 0 */ 57e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard if (xy < 0) 58e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard return ((Word16) 0); 59e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 60e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard /* compute gain = xy/yy */ 61e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 62e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard xy >>= 1; /* Be sure xy < yy */ 63e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard gain = div_s(xy, yy); 64e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 65e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard i = exp_xy; 66e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard i -= exp_yy; 67e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 68b676a05348e4c516fa8b57e33b10548e6142c3f8Mans Rullgard gain = shl(gain, i); 69e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 70e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard /* if (gain > 1.2) gain = 1.2 in Q14 */ 71e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard if(gain > 19661) 72e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard { 73b676a05348e4c516fa8b57e33b10548e6142c3f8Mans Rullgard gain = 19661; 74e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard } 75e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard return (gain); 76e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard} 77e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 78e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 79e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 80