autocorr.c revision e2e838afcf03e603a41a0455846eaf9614537c16
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/*********************************************************************** 19e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard* File: autocorr.c * 20e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard* * 21e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard* Description:Compute autocorrelations of signal with windowing * 22e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard* * 23e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard************************************************************************/ 24e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 25e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard#include "typedef.h" 26e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard#include "basic_op.h" 27e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard#include "oper_32b.h" 28e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard#include "acelp.h" 29e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard#include "ham_wind.tab" 30e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 31e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgardvoid Autocorr( 32e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard Word16 x[], /* (i) : Input signal */ 33e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard Word16 m, /* (i) : LPC order */ 34e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard Word16 r_h[], /* (o) Q15: Autocorrelations (msb) */ 35e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard Word16 r_l[] /* (o) : Autocorrelations (lsb) */ 36e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard ) 37e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard{ 38e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard Word32 i, norm, shift; 39e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard Word16 y[L_WINDOW]; 40e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard Word32 L_sum, L_sum1, L_tmp, F_LEN; 41e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard Word16 *p1,*p2,*p3; 42e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard const Word16 *p4; 43e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard /* Windowing of signal */ 44e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard p1 = x; 45e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard p4 = vo_window; 46e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard p3 = y; 47e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 48e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard for (i = 0; i < L_WINDOW; i+=4) 49e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard { 50e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard *p3++ = vo_mult_r((*p1++), (*p4++)); 51e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard *p3++ = vo_mult_r((*p1++), (*p4++)); 52e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard *p3++ = vo_mult_r((*p1++), (*p4++)); 53e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard *p3++ = vo_mult_r((*p1++), (*p4++)); 54e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard } 55e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 56e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard /* calculate energy of signal */ 57e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_sum = vo_L_deposit_h(16); /* sqrt(256), avoid overflow after rounding */ 58e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard for (i = 0; i < L_WINDOW; i++) 59e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard { 60e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_tmp = vo_L_mult(y[i], y[i]); 61e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_tmp = (L_tmp >> 8); 62e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_sum += L_tmp; 63e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard } 64e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 65e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard /* scale signal to avoid overflow in autocorrelation */ 66e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard norm = norm_l(L_sum); 67e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard shift = 4 - (norm >> 1); 68e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard if(shift > 0) 69e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard { 70e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard p1 = y; 71e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard for (i = 0; i < L_WINDOW; i+=4) 72e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard { 73e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard *p1 = vo_shr_r(*p1, shift); 74e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard p1++; 75e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard *p1 = vo_shr_r(*p1, shift); 76e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard p1++; 77e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard *p1 = vo_shr_r(*p1, shift); 78e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard p1++; 79e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard *p1 = vo_shr_r(*p1, shift); 80e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard p1++; 81e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard } 82e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard } 83e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 84e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard /* Compute and normalize r[0] */ 85e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_sum = 1; 86e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard for (i = 0; i < L_WINDOW; i+=4) 87e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard { 88e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_sum += vo_L_mult(y[i], y[i]); 89e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_sum += vo_L_mult(y[i+1], y[i+1]); 90e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_sum += vo_L_mult(y[i+2], y[i+2]); 91e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_sum += vo_L_mult(y[i+3], y[i+3]); 92e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard } 93e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 94e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard norm = norm_l(L_sum); 95e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_sum = (L_sum << norm); 96e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 97e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard r_h[0] = L_sum >> 16; 98e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard r_l[0] = (L_sum & 0xffff)>>1; 99e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 100e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard /* Compute r[1] to r[m] */ 101e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard for (i = 1; i <= 8; i++) 102e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard { 103e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_sum1 = 0; 104e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_sum = 0; 105e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard F_LEN = (Word32)(L_WINDOW - 2*i); 106e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard p1 = y; 107e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard p2 = y + (2*i)-1; 108e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard do{ 109e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_sum1 += *p1 * *p2++; 110e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_sum += *p1++ * *p2; 111e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard }while(--F_LEN!=0); 112e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 113e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_sum1 += *p1 * *p2++; 114e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 115e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_sum1 = L_sum1<<norm; 116e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_sum = L_sum<<norm; 117e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 118e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard r_h[(2*i)-1] = L_sum1 >> 15; 119e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard r_l[(2*i)-1] = L_sum1 & 0x00007fff; 120e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard r_h[(2*i)] = L_sum >> 15; 121e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard r_l[(2*i)] = L_sum & 0x00007fff; 122e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard } 123e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard return; 124e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard} 125e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 126e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 127e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 128