/*
 * Copyright (C) 2004-2010 NXP Software
 * Copyright (C) 2010 The Android Open Source Project
 *
 * 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.
 */


/************************************************************************************/
/*                                                                                  */
/*    Includes                                                                      */
/*                                                                                  */
/************************************************************************************/

#include "LVDBE.h"
#include "LVDBE_Coeffs.h"               /* Filter coefficients */
#include "BIQUAD.h"


/************************************************************************************/
/*                                                                                  */
/*    Coefficients constant table                                                   */
/*                                                                                  */
/************************************************************************************/

/*
 * High Pass Filter Coefficient table
 */
const BQ_C32_Coefs_t LVDBE_HPF_Table[] = {
    /* Coefficients for 55Hz centre frequency */
    {HPF_Fs8000_Fc55_A2,                /* 8kS/s coefficients */
     HPF_Fs8000_Fc55_A1,
     HPF_Fs8000_Fc55_A0,
     -HPF_Fs8000_Fc55_B2,
     -HPF_Fs8000_Fc55_B1},
    {HPF_Fs11025_Fc55_A2,                /* 11kS/s coefficients */
     HPF_Fs11025_Fc55_A1,
     HPF_Fs11025_Fc55_A0,
     -HPF_Fs11025_Fc55_B2,
     -HPF_Fs11025_Fc55_B1},
    {HPF_Fs12000_Fc55_A2,                /* 12kS/s coefficients */
     HPF_Fs12000_Fc55_A1,
     HPF_Fs12000_Fc55_A0,
     -HPF_Fs12000_Fc55_B2,
     -HPF_Fs12000_Fc55_B1},
    {HPF_Fs16000_Fc55_A2,                /* 16kS/s coefficients */
     HPF_Fs16000_Fc55_A1,
     HPF_Fs16000_Fc55_A0,
     -HPF_Fs16000_Fc55_B2,
     -HPF_Fs16000_Fc55_B1},
    {HPF_Fs22050_Fc55_A2,                /* 22kS/s coefficients */
     HPF_Fs22050_Fc55_A1,
     HPF_Fs22050_Fc55_A0,
     -HPF_Fs22050_Fc55_B2,
     -HPF_Fs22050_Fc55_B1},
    {HPF_Fs24000_Fc55_A2,                /* 24kS/s coefficients */
     HPF_Fs24000_Fc55_A1,
     HPF_Fs24000_Fc55_A0,
     -HPF_Fs24000_Fc55_B2,
     -HPF_Fs24000_Fc55_B1},
    {HPF_Fs32000_Fc55_A2,                /* 32kS/s coefficients */
     HPF_Fs32000_Fc55_A1,
     HPF_Fs32000_Fc55_A0,
     -HPF_Fs32000_Fc55_B2,
     -HPF_Fs32000_Fc55_B1},
    {HPF_Fs44100_Fc55_A2,                /* 44kS/s coefficients */
     HPF_Fs44100_Fc55_A1,
     HPF_Fs44100_Fc55_A0,
     -HPF_Fs44100_Fc55_B2,
     -HPF_Fs44100_Fc55_B1},
    {HPF_Fs48000_Fc55_A2,                /* 48kS/s coefficients */
     HPF_Fs48000_Fc55_A1,
     HPF_Fs48000_Fc55_A0,
     -HPF_Fs48000_Fc55_B2,
     -HPF_Fs48000_Fc55_B1},

    /* Coefficients for 66Hz centre frequency */
    {HPF_Fs8000_Fc66_A2,                /* 8kS/s coefficients */
     HPF_Fs8000_Fc66_A1,
     HPF_Fs8000_Fc66_A0,
     -HPF_Fs8000_Fc66_B2,
     -HPF_Fs8000_Fc66_B1},
    {HPF_Fs11025_Fc66_A2,                /* 11kS/s coefficients */
     HPF_Fs11025_Fc66_A1,
     HPF_Fs11025_Fc66_A0,
     -HPF_Fs11025_Fc66_B2,
     -HPF_Fs11025_Fc66_B1},
    {HPF_Fs12000_Fc66_A2,                /* 12kS/s coefficients */
     HPF_Fs12000_Fc66_A1,
     HPF_Fs12000_Fc66_A0,
     -HPF_Fs12000_Fc66_B2,
     -HPF_Fs12000_Fc66_B1},
    {HPF_Fs16000_Fc66_A2,                /* 16kS/s coefficients */
     HPF_Fs16000_Fc66_A1,
     HPF_Fs16000_Fc66_A0,
     -HPF_Fs16000_Fc66_B2,
     -HPF_Fs16000_Fc66_B1},
    {HPF_Fs22050_Fc66_A2,                /* 22kS/s coefficients */
     HPF_Fs22050_Fc66_A1,
     HPF_Fs22050_Fc66_A0,
     -HPF_Fs22050_Fc66_B2,
     -HPF_Fs22050_Fc66_B1},
    {HPF_Fs24000_Fc66_A2,                /* 24kS/s coefficients */
     HPF_Fs24000_Fc66_A1,
     HPF_Fs24000_Fc66_A0,
     -HPF_Fs24000_Fc66_B2,
     -HPF_Fs24000_Fc66_B1},
    {HPF_Fs32000_Fc66_A2,                /* 32kS/s coefficients */
     HPF_Fs32000_Fc66_A1,
     HPF_Fs32000_Fc66_A0,
     -HPF_Fs32000_Fc66_B2,
     -HPF_Fs32000_Fc66_B1},
    {HPF_Fs44100_Fc66_A2,                /* 44kS/s coefficients */
     HPF_Fs44100_Fc66_A1,
     HPF_Fs44100_Fc66_A0,
     -HPF_Fs44100_Fc66_B2,
     -HPF_Fs44100_Fc66_B1},
    {HPF_Fs48000_Fc66_A2,                /* 48kS/s coefficients */
     HPF_Fs48000_Fc66_A1,
     HPF_Fs48000_Fc66_A0,
     -HPF_Fs48000_Fc66_B2,
     -HPF_Fs48000_Fc66_B1},

    /* Coefficients for 78Hz centre frequency */
    {HPF_Fs8000_Fc78_A2,                /* 8kS/s coefficients */
     HPF_Fs8000_Fc78_A1,
     HPF_Fs8000_Fc78_A0,
     -HPF_Fs8000_Fc78_B2,
     -HPF_Fs8000_Fc78_B1},
    {HPF_Fs11025_Fc78_A2,                /* 11kS/s coefficients */
     HPF_Fs11025_Fc78_A1,
     HPF_Fs11025_Fc78_A0,
     -HPF_Fs11025_Fc78_B2,
     -HPF_Fs11025_Fc78_B1},
    {HPF_Fs12000_Fc78_A2,                /* 12kS/s coefficients */
     HPF_Fs12000_Fc78_A1,
     HPF_Fs12000_Fc78_A0,
     -HPF_Fs12000_Fc78_B2,
     -HPF_Fs12000_Fc78_B1},
    {HPF_Fs16000_Fc78_A2,                /* 16kS/s coefficients */
     HPF_Fs16000_Fc78_A1,
     HPF_Fs16000_Fc78_A0,
     -HPF_Fs16000_Fc78_B2,
     -HPF_Fs16000_Fc78_B1},
    {HPF_Fs22050_Fc78_A2,                /* 22kS/s coefficients */
     HPF_Fs22050_Fc78_A1,
     HPF_Fs22050_Fc78_A0,
     -HPF_Fs22050_Fc78_B2,
     -HPF_Fs22050_Fc78_B1},
    {HPF_Fs24000_Fc78_A2,                /* 24kS/s coefficients */
     HPF_Fs24000_Fc78_A1,
     HPF_Fs24000_Fc78_A0,
     -HPF_Fs24000_Fc78_B2,
     -HPF_Fs24000_Fc78_B1},
    {HPF_Fs32000_Fc78_A2,                /* 32kS/s coefficients */
     HPF_Fs32000_Fc78_A1,
     HPF_Fs32000_Fc78_A0,
     -HPF_Fs32000_Fc78_B2,
     -HPF_Fs32000_Fc78_B1},
    {HPF_Fs44100_Fc78_A2,                /* 44kS/s coefficients */
     HPF_Fs44100_Fc78_A1,
     HPF_Fs44100_Fc78_A0,
     -HPF_Fs44100_Fc78_B2,
     -HPF_Fs44100_Fc78_B1},
    {HPF_Fs48000_Fc78_A2,                /* 48kS/s coefficients */
     HPF_Fs48000_Fc78_A1,
     HPF_Fs48000_Fc78_A0,
     -HPF_Fs48000_Fc78_B2,
     -HPF_Fs48000_Fc78_B1},

    /* Coefficients for 90Hz centre frequency */
    {HPF_Fs8000_Fc90_A2,                /* 8kS/s coefficients */
     HPF_Fs8000_Fc90_A1,
     HPF_Fs8000_Fc90_A0,
     -HPF_Fs8000_Fc90_B2,
     -HPF_Fs8000_Fc90_B1},
    {HPF_Fs11025_Fc90_A2,                /* 11kS/s coefficients */
     HPF_Fs11025_Fc90_A1,
     HPF_Fs11025_Fc90_A0,
     -HPF_Fs11025_Fc90_B2,
     -HPF_Fs11025_Fc90_B1},
    {HPF_Fs12000_Fc90_A2,                /* 12kS/s coefficients */
     HPF_Fs12000_Fc90_A1,
     HPF_Fs12000_Fc90_A0,
     -HPF_Fs12000_Fc90_B2,
     -HPF_Fs12000_Fc90_B1},
    {HPF_Fs16000_Fc90_A2,                /* 16kS/s coefficients */
     HPF_Fs16000_Fc90_A1,
     HPF_Fs16000_Fc90_A0,
     -HPF_Fs16000_Fc90_B2,
     -HPF_Fs16000_Fc90_B1},
    {HPF_Fs22050_Fc90_A2,                /* 22kS/s coefficients */
     HPF_Fs22050_Fc90_A1,
     HPF_Fs22050_Fc90_A0,
     -HPF_Fs22050_Fc90_B2,
     -HPF_Fs22050_Fc90_B1},
    {HPF_Fs24000_Fc90_A2,                /* 24kS/s coefficients */
     HPF_Fs24000_Fc90_A1,
     HPF_Fs24000_Fc90_A0,
     -HPF_Fs24000_Fc90_B2,
     -HPF_Fs24000_Fc90_B1},
    {HPF_Fs32000_Fc90_A2,                /* 32kS/s coefficients */
     HPF_Fs32000_Fc90_A1,
     HPF_Fs32000_Fc90_A0,
     -HPF_Fs32000_Fc90_B2,
     -HPF_Fs32000_Fc90_B1},
    {HPF_Fs44100_Fc90_A2,                /* 44kS/s coefficients */
     HPF_Fs44100_Fc90_A1,
     HPF_Fs44100_Fc90_A0,
     -HPF_Fs44100_Fc90_B2,
     -HPF_Fs44100_Fc90_B1},
    {HPF_Fs48000_Fc90_A2,                /* 48kS/s coefficients */
     HPF_Fs48000_Fc90_A1,
     HPF_Fs48000_Fc90_A0,
     -HPF_Fs48000_Fc90_B2,
     -HPF_Fs48000_Fc90_B1}};

/*
 * Band Pass Filter coefficient table
 */
const BP_C32_Coefs_t LVDBE_BPF_Table[] = {
    /* Coefficients for 55Hz centre frequency */
    {BPF_Fs8000_Fc55_A0,                /* 8kS/s coefficients */
     -BPF_Fs8000_Fc55_B2,
     -BPF_Fs8000_Fc55_B1},
    {BPF_Fs11025_Fc55_A0,                /* 11kS/s coefficients */
     -BPF_Fs11025_Fc55_B2,
     -BPF_Fs11025_Fc55_B1},
    {BPF_Fs12000_Fc55_A0,                /* 12kS/s coefficients */
     -BPF_Fs12000_Fc55_B2,
     -BPF_Fs12000_Fc55_B1},
    {BPF_Fs16000_Fc55_A0,                /* 16kS/s coefficients */
     -BPF_Fs16000_Fc55_B2,
     -BPF_Fs16000_Fc55_B1},
    {BPF_Fs22050_Fc55_A0,                /* 22kS/s coefficients */
     -BPF_Fs22050_Fc55_B2,
     -BPF_Fs22050_Fc55_B1},
    {BPF_Fs24000_Fc55_A0,                /* 24kS/s coefficients */
     -BPF_Fs24000_Fc55_B2,
     -BPF_Fs24000_Fc55_B1},
    {BPF_Fs32000_Fc55_A0,                /* 32kS/s coefficients */
     -BPF_Fs32000_Fc55_B2,
     -BPF_Fs32000_Fc55_B1},
    {BPF_Fs44100_Fc55_A0,                /* 44kS/s coefficients */
     -BPF_Fs44100_Fc55_B2,
     -BPF_Fs44100_Fc55_B1},
    {BPF_Fs48000_Fc55_A0,                /* 48kS/s coefficients */
     -BPF_Fs48000_Fc55_B2,
     -BPF_Fs48000_Fc55_B1},

    /* Coefficients for 66Hz centre frequency */
    {BPF_Fs8000_Fc66_A0,                /* 8kS/s coefficients */
     -BPF_Fs8000_Fc66_B2,
     -BPF_Fs8000_Fc66_B1},
    {BPF_Fs11025_Fc66_A0,                /* 11kS/s coefficients */
     -BPF_Fs11025_Fc66_B2,
     -BPF_Fs11025_Fc66_B1},
    {BPF_Fs12000_Fc66_A0,                /* 12kS/s coefficients */
     -BPF_Fs12000_Fc66_B2,
     -BPF_Fs12000_Fc66_B1},
    {BPF_Fs16000_Fc66_A0,                /* 16kS/s coefficients */
     -BPF_Fs16000_Fc66_B2,
     -BPF_Fs16000_Fc66_B1},
    {BPF_Fs22050_Fc66_A0,                /* 22kS/s coefficients */
     -BPF_Fs22050_Fc66_B2,
     -BPF_Fs22050_Fc66_B1},
    {BPF_Fs24000_Fc66_A0,                /* 24kS/s coefficients */
     -BPF_Fs24000_Fc66_B2,
     -BPF_Fs24000_Fc66_B1},
    {BPF_Fs32000_Fc66_A0,                /* 32kS/s coefficients */
     -BPF_Fs32000_Fc66_B2,
     -BPF_Fs32000_Fc66_B1},
    {BPF_Fs44100_Fc66_A0,                /* 44kS/s coefficients */
     -BPF_Fs44100_Fc66_B2,
     -BPF_Fs44100_Fc66_B1},
    {BPF_Fs48000_Fc66_A0,                /* 48kS/s coefficients */
     -BPF_Fs48000_Fc66_B2,
     -BPF_Fs48000_Fc66_B1},

    /* Coefficients for 78Hz centre frequency */
    {BPF_Fs8000_Fc78_A0,                /* 8kS/s coefficients */
     -BPF_Fs8000_Fc78_B2,
     -BPF_Fs8000_Fc78_B1},
    {BPF_Fs11025_Fc78_A0,                /* 11kS/s coefficients */
     -BPF_Fs11025_Fc78_B2,
     -BPF_Fs11025_Fc78_B1},
    {BPF_Fs12000_Fc78_A0,                /* 12kS/s coefficients */
     -BPF_Fs12000_Fc78_B2,
     -BPF_Fs12000_Fc78_B1},
    {BPF_Fs16000_Fc78_A0,                /* 16kS/s coefficients */
     -BPF_Fs16000_Fc78_B2,
     -BPF_Fs16000_Fc78_B1},
    {BPF_Fs22050_Fc78_A0,                /* 22kS/s coefficients */
     -BPF_Fs22050_Fc78_B2,
     -BPF_Fs22050_Fc78_B1},
    {BPF_Fs24000_Fc78_A0,                /* 24kS/s coefficients */
     -BPF_Fs24000_Fc78_B2,
     -BPF_Fs24000_Fc78_B1},
    {BPF_Fs32000_Fc78_A0,                /* 32kS/s coefficients */
     -BPF_Fs32000_Fc78_B2,
     -BPF_Fs32000_Fc78_B1},
    {BPF_Fs44100_Fc78_A0,                /* 44kS/s coefficients */
     -BPF_Fs44100_Fc78_B2,
     -BPF_Fs44100_Fc78_B1},
    {BPF_Fs48000_Fc78_A0,                /* 48kS/s coefficients */
     -BPF_Fs48000_Fc78_B2,
     -BPF_Fs48000_Fc78_B1},

    /* Coefficients for 90Hz centre frequency */
    {BPF_Fs8000_Fc90_A0,                /* 8kS/s coefficients */
     -BPF_Fs8000_Fc90_B2,
     -BPF_Fs8000_Fc90_B1},
    {BPF_Fs11025_Fc90_A0,                /* 11kS/s coefficients */
     -BPF_Fs11025_Fc90_B2,
     -BPF_Fs11025_Fc90_B1},
    {BPF_Fs12000_Fc90_A0,                /* 12kS/s coefficients */
     -BPF_Fs12000_Fc90_B2,
     -BPF_Fs12000_Fc90_B1},
    {BPF_Fs16000_Fc90_A0,                /* 16kS/s coefficients */
     -BPF_Fs16000_Fc90_B2,
     -BPF_Fs16000_Fc90_B1},
    {BPF_Fs22050_Fc90_A0,                /* 22kS/s coefficients */
     -BPF_Fs22050_Fc90_B2,
     -BPF_Fs22050_Fc90_B1},
    {BPF_Fs24000_Fc90_A0,                /* 24kS/s coefficients */
     -BPF_Fs24000_Fc90_B2,
     -BPF_Fs24000_Fc90_B1},
    {BPF_Fs32000_Fc90_A0,                /* 32kS/s coefficients */
     -BPF_Fs32000_Fc90_B2,
     -BPF_Fs32000_Fc90_B1},
    {BPF_Fs44100_Fc90_A0,                /* 44kS/s coefficients */
     -BPF_Fs44100_Fc90_B2,
     -BPF_Fs44100_Fc90_B1},
    {BPF_Fs48000_Fc90_A0,                /* 48kS/s coefficients */
     -BPF_Fs48000_Fc90_B2,
     -BPF_Fs48000_Fc90_B1}};


/************************************************************************************/
/*                                                                                  */
/*    AGC constant tables                                                           */
/*                                                                                  */
/************************************************************************************/

/* Attack time (signal too large) */
const LVM_INT16 LVDBE_AGC_ATTACK_Table[] = {
    AGC_ATTACK_Fs8000,
    AGC_ATTACK_Fs11025,
    AGC_ATTACK_Fs12000,
    AGC_ATTACK_Fs16000,
    AGC_ATTACK_Fs22050,
    AGC_ATTACK_Fs24000,
    AGC_ATTACK_Fs32000,
    AGC_ATTACK_Fs44100,
    AGC_ATTACK_Fs48000};

/* Decay time (signal too small) */
const LVM_INT16 LVDBE_AGC_DECAY_Table[] = {
    AGC_DECAY_Fs8000,
    AGC_DECAY_Fs11025,
    AGC_DECAY_Fs12000,
    AGC_DECAY_Fs16000,
    AGC_DECAY_Fs22050,
    AGC_DECAY_Fs24000,
    AGC_DECAY_Fs32000,
    AGC_DECAY_Fs44100,
    AGC_DECAY_Fs48000};

/* Gain for use without the high pass filter */
const LVM_INT32 LVDBE_AGC_GAIN_Table[] = {
    AGC_GAIN_0dB,
    AGC_GAIN_1dB,
    AGC_GAIN_2dB,
    AGC_GAIN_3dB,
    AGC_GAIN_4dB,
    AGC_GAIN_5dB,
    AGC_GAIN_6dB,
    AGC_GAIN_7dB,
    AGC_GAIN_8dB,
    AGC_GAIN_9dB,
    AGC_GAIN_10dB,
    AGC_GAIN_11dB,
    AGC_GAIN_12dB,
    AGC_GAIN_13dB,
    AGC_GAIN_14dB,
    AGC_GAIN_15dB};

/* Gain for use with the high pass filter */
const LVM_INT32 LVDBE_AGC_HPFGAIN_Table[] = {
    AGC_HPFGAIN_0dB,
    AGC_HPFGAIN_1dB,
    AGC_HPFGAIN_2dB,
    AGC_HPFGAIN_3dB,
    AGC_HPFGAIN_4dB,
    AGC_HPFGAIN_5dB,
    AGC_HPFGAIN_6dB,
    AGC_HPFGAIN_7dB,
    AGC_HPFGAIN_8dB,
    AGC_HPFGAIN_9dB,
    AGC_HPFGAIN_10dB,
    AGC_HPFGAIN_11dB,
    AGC_HPFGAIN_12dB,
    AGC_HPFGAIN_13dB,
    AGC_HPFGAIN_14dB,
    AGC_HPFGAIN_15dB};


/************************************************************************************/
/*                                                                                  */
/*    Volume control gain and time constant tables                                  */
/*                                                                                  */
/************************************************************************************/

/* dB to linear conversion table */
const LVM_INT16 LVDBE_VolumeTable[] = {
    0x4000,             /* -6dB */
    0x47FB,             /* -5dB */
    0x50C3,             /* -4dB */
    0x5A9E,             /* -3dB */
    0x65AD,             /* -2dB */
    0x7215,             /* -1dB */
    0x7FFF};            /*  0dB */

const LVM_INT16 LVDBE_VolumeTCTable[] = {
    VOL_TC_Fs8000,
    VOL_TC_Fs11025,
    VOL_TC_Fs12000,
    VOL_TC_Fs16000,
    VOL_TC_Fs22050,
    VOL_TC_Fs24000,
    VOL_TC_Fs32000,
    VOL_TC_Fs44100,
    VOL_TC_Fs48000};

const LVM_INT16 LVDBE_MixerTCTable[] = {
    MIX_TC_Fs8000,
    MIX_TC_Fs11025,
    MIX_TC_Fs12000,
    MIX_TC_Fs16000,
    MIX_TC_Fs22050,
    MIX_TC_Fs24000,
    MIX_TC_Fs32000,
    MIX_TC_Fs44100,
    MIX_TC_Fs48000};