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: hp6k.c * 19e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard* * 20e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard* Description:15th order band pass 6kHz to 7kHz FIR filter * 21e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard* frequency: 4kHz 5kHz 5.5kHz 6kHz 6.5kHz 7kHz 7.5kHz 8kHz * 22e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard* dB loss: -60dB -45dB -13dB -3dB 0dB -3dB -13dB -45dB * 23b676a05348e4c516fa8b57e33b10548e6142c3f8Mans Rullgard* * 24e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard************************************************************************/ 25e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 26e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard#include "typedef.h" 27e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard#include "basic_op.h" 28e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard#include "acelp.h" 29e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard#include "cnst.h" 30e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 31e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard#define L_FIR 31 32e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 33e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard/* filter coefficients (gain=4.0) */ 34e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 35e2e838afcf03e603a41a0455846eaf9614537c16Mans RullgardWord16 fir_6k_7k[L_FIR] = 36e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard{ 37e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard -32, 47, 32, -27, -369, 38e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 1122, -1421, 0, 3798, -8880, 39e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 12349, -10984, 3548, 7766, -18001, 40e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 22118, -18001, 7766, 3548, -10984, 41e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 12349, -8880, 3798, 0, -1421, 42e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 1122, -369, -27, 32, 47, 43e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard -32 44e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard}; 45e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 46e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 47e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgardvoid Init_Filt_6k_7k(Word16 mem[]) /* mem[30] */ 48e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard{ 49e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard Set_zero(mem, L_FIR - 1); 50e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard return; 51e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard} 52e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 53e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgardvoid Filt_6k_7k( 54e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard Word16 signal[], /* input: signal */ 55e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard Word16 lg, /* input: length of input */ 56e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard Word16 mem[] /* in/out: memory (size=30) */ 57e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard ) 58e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard{ 59e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard Word16 x[L_SUBFR16k + (L_FIR - 1)]; 60e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard Word32 i, L_tmp; 61e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 62e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard Copy(mem, x, L_FIR - 1); 63e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard for (i = lg - 1; i >= 0; i--) 64e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard { 65e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard x[i + L_FIR - 1] = signal[i] >> 2; /* gain of filter = 4 */ 66b676a05348e4c516fa8b57e33b10548e6142c3f8Mans Rullgard } 67e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard for (i = 0; i < lg; i++) 68e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard { 69e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_tmp = (x[i] + x[i+ 30]) * fir_6k_7k[0]; 70e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_tmp += (x[i+1] + x[i + 29]) * fir_6k_7k[1]; 71e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_tmp += (x[i+2] + x[i + 28]) * fir_6k_7k[2]; 72e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_tmp += (x[i+3] + x[i + 27]) * fir_6k_7k[3]; 73e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_tmp += (x[i+4] + x[i + 26]) * fir_6k_7k[4]; 74e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_tmp += (x[i+5] + x[i + 25]) * fir_6k_7k[5]; 75e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_tmp += (x[i+6] + x[i + 24]) * fir_6k_7k[6]; 76e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_tmp += (x[i+7] + x[i + 23]) * fir_6k_7k[7]; 77e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_tmp += (x[i+8] + x[i + 22]) * fir_6k_7k[8]; 78e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_tmp += (x[i+9] + x[i + 21]) * fir_6k_7k[9]; 79e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_tmp += (x[i+10] + x[i + 20]) * fir_6k_7k[10]; 80e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_tmp += (x[i+11] + x[i + 19]) * fir_6k_7k[11]; 81e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_tmp += (x[i+12] + x[i + 18]) * fir_6k_7k[12]; 82e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_tmp += (x[i+13] + x[i + 17]) * fir_6k_7k[13]; 83e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_tmp += (x[i+14] + x[i + 16]) * fir_6k_7k[14]; 84e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard L_tmp += (x[i+15]) * fir_6k_7k[15]; 85e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard signal[i] = (L_tmp + 0x4000) >> 15; 86e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard } 87e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 88e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard Copy(x + lg, mem, L_FIR - 1); 89e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 90e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard} 91e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 92e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 93e2e838afcf03e603a41a0455846eaf9614537c16Mans Rullgard 94