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* * 205d5c3a132bb446ac78a37dfaac24a46cacf0dd73Marco Nelissen* Description:Compute the gain of pitch. Result in Q12 * 215d5c3a132bb446ac78a37dfaac24a46cacf0dd73Marco Nelissen* if(gain < 0) gain = 0 * 225d5c3a132bb446ac78a37dfaac24a46cacf0dd73Marco Nelissen* 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 */ 305d5c3a132bb446ac78a37dfaac24a46cacf0dd73Marco Nelissen Word16 xn[], /* (i) : Pitch target. */ 315d5c3a132bb446ac78a37dfaac24a46cacf0dd73Marco Nelissen Word16 y1[], /* (i) : filtered adaptive codebook. */ 325d5c3a132bb446ac78a37dfaac24a46cacf0dd73Marco Nelissen Word16 g_coeff[], /* : Correlations need for gain quantization. */ 335d5c3a132bb446ac78a37dfaac24a46cacf0dd73Marco Nelissen Word16 L_subfr /* : Length of subframe. */ 345d5c3a132bb446ac78a37dfaac24a46cacf0dd73Marco Nelissen ) 35e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard{ 365d5c3a132bb446ac78a37dfaac24a46cacf0dd73Marco Nelissen Word32 i; 375d5c3a132bb446ac78a37dfaac24a46cacf0dd73Marco Nelissen Word16 xy, yy, exp_xy, exp_yy, gain; 385d5c3a132bb446ac78a37dfaac24a46cacf0dd73Marco Nelissen /* Compute scalar product <y1[],y1[]> */ 39e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard#ifdef ASM_OPT /* asm optimization branch */ 405d5c3a132bb446ac78a37dfaac24a46cacf0dd73Marco Nelissen /* Compute scalar product <xn[],y1[]> */ 415d5c3a132bb446ac78a37dfaac24a46cacf0dd73Marco Nelissen xy = extract_h(Dot_product12_asm(xn, y1, L_subfr, &exp_xy)); 425d5c3a132bb446ac78a37dfaac24a46cacf0dd73Marco Nelissen yy = extract_h(Dot_product12_asm(y1, y1, L_subfr, &exp_yy)); 43e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 44e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard#else 455d5c3a132bb446ac78a37dfaac24a46cacf0dd73Marco Nelissen /* Compute scalar product <xn[],y1[]> */ 465d5c3a132bb446ac78a37dfaac24a46cacf0dd73Marco Nelissen xy = extract_h(Dot_product12(xn, y1, L_subfr, &exp_xy)); 475d5c3a132bb446ac78a37dfaac24a46cacf0dd73Marco Nelissen yy = extract_h(Dot_product12(y1, y1, L_subfr, &exp_yy)); 48e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 49e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard#endif 50e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 515d5c3a132bb446ac78a37dfaac24a46cacf0dd73Marco Nelissen g_coeff[0] = yy; 525d5c3a132bb446ac78a37dfaac24a46cacf0dd73Marco Nelissen g_coeff[1] = exp_yy; 535d5c3a132bb446ac78a37dfaac24a46cacf0dd73Marco Nelissen g_coeff[2] = xy; 545d5c3a132bb446ac78a37dfaac24a46cacf0dd73Marco Nelissen g_coeff[3] = exp_xy; 55e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 565d5c3a132bb446ac78a37dfaac24a46cacf0dd73Marco Nelissen /* If (xy < 0) gain = 0 */ 575d5c3a132bb446ac78a37dfaac24a46cacf0dd73Marco Nelissen if (xy < 0) 585d5c3a132bb446ac78a37dfaac24a46cacf0dd73Marco Nelissen return ((Word16) 0); 59e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 605d5c3a132bb446ac78a37dfaac24a46cacf0dd73Marco Nelissen /* compute gain = xy/yy */ 61e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 625d5c3a132bb446ac78a37dfaac24a46cacf0dd73Marco Nelissen xy >>= 1; /* Be sure xy < yy */ 635d5c3a132bb446ac78a37dfaac24a46cacf0dd73Marco Nelissen gain = div_s(xy, yy); 64e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 655d5c3a132bb446ac78a37dfaac24a46cacf0dd73Marco Nelissen i = exp_xy; 665d5c3a132bb446ac78a37dfaac24a46cacf0dd73Marco Nelissen i -= exp_yy; 67e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 685d5c3a132bb446ac78a37dfaac24a46cacf0dd73Marco Nelissen gain = shl(gain, i); 69e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 705d5c3a132bb446ac78a37dfaac24a46cacf0dd73Marco Nelissen /* if (gain > 1.2) gain = 1.2 in Q14 */ 715d5c3a132bb446ac78a37dfaac24a46cacf0dd73Marco Nelissen if(gain > 19661) 725d5c3a132bb446ac78a37dfaac24a46cacf0dd73Marco Nelissen { 735d5c3a132bb446ac78a37dfaac24a46cacf0dd73Marco Nelissen gain = 19661; 745d5c3a132bb446ac78a37dfaac24a46cacf0dd73Marco Nelissen } 755d5c3a132bb446ac78a37dfaac24a46cacf0dd73Marco Nelissen return (gain); 76e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard} 77e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 78e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 79e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 80