/*
 ** Copyright 2003-2010, VisualOn, Inc.
 **
 ** Licensed under the Apache License, Version 2.0 (the "License");
 ** you may not use this file except in compliance with the License.
 ** You may obtain a copy of the License at
 **
 **     http://www.apache.org/licenses/LICENSE-2.0
 **
 ** Unless required by applicable law or agreed to in writing, software
 ** distributed under the License is distributed on an "AS IS" BASIS,
 ** WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 ** See the License for the specific language governing permissions and
 ** limitations under the License.
 */

/***********************************************************************
*       File: hp6k.c                                                    *
*                                                                       *
*   Description:15th order band pass 6kHz to 7kHz FIR filter        *
*       frequency: 4kHz   5kHz  5.5kHz  6kHz  6.5kHz  7kHz 7.5kHz 8kHz  *
*   dB loss:  -60dB  -45dB  -13dB   -3dB   0dB    -3dB -13dB  -45dB *
*                                                                   *
************************************************************************/

#include "typedef.h"
#include "basic_op.h"
#include "acelp.h"
#include "cnst.h"

#define L_FIR 31

/* filter coefficients (gain=4.0) */

Word16 fir_6k_7k[L_FIR] =
{
    -32, 47, 32, -27, -369,
    1122, -1421, 0, 3798, -8880,
    12349, -10984, 3548, 7766, -18001,
    22118, -18001, 7766, 3548, -10984,
    12349, -8880, 3798, 0, -1421,
    1122, -369, -27, 32, 47,
    -32
};


void Init_Filt_6k_7k(Word16 mem[])         /* mem[30] */
{
    Set_zero(mem, L_FIR - 1);
    return;
}

void Filt_6k_7k(
        Word16 signal[],                      /* input:  signal                  */
        Word16 lg,                            /* input:  length of input         */
        Word16 mem[]                          /* in/out: memory (size=30)        */
           )
{
    Word16 x[L_SUBFR16k + (L_FIR - 1)];
    Word32 i, L_tmp;

    Copy(mem, x, L_FIR - 1);
    for (i = lg - 1; i >= 0; i--)
    {
        x[i + L_FIR - 1] = signal[i] >> 2;                         /* gain of filter = 4 */
    }
    for (i = 0; i < lg; i++)
    {
        L_tmp =  (x[i] + x[i+ 30]) * fir_6k_7k[0];
        L_tmp += (x[i+1] + x[i + 29]) * fir_6k_7k[1];
        L_tmp += (x[i+2] + x[i + 28]) * fir_6k_7k[2];
        L_tmp += (x[i+3] + x[i + 27]) * fir_6k_7k[3];
        L_tmp += (x[i+4] + x[i + 26]) * fir_6k_7k[4];
        L_tmp += (x[i+5] + x[i + 25]) * fir_6k_7k[5];
        L_tmp += (x[i+6] + x[i + 24]) * fir_6k_7k[6];
        L_tmp += (x[i+7] + x[i + 23]) * fir_6k_7k[7];
        L_tmp += (x[i+8] + x[i + 22]) * fir_6k_7k[8];
        L_tmp += (x[i+9] + x[i + 21]) * fir_6k_7k[9];
        L_tmp += (x[i+10] + x[i + 20]) * fir_6k_7k[10];
        L_tmp += (x[i+11] + x[i + 19]) * fir_6k_7k[11];
        L_tmp += (x[i+12] + x[i + 18]) * fir_6k_7k[12];
        L_tmp += (x[i+13] + x[i + 17]) * fir_6k_7k[13];
        L_tmp += (x[i+14] + x[i + 16]) * fir_6k_7k[14];
        L_tmp += (x[i+15]) * fir_6k_7k[15];
        signal[i] = (L_tmp + 0x4000) >> 15;
    }

    Copy(x + lg, mem, L_FIR - 1);

}