/* ------------------------------------------------------------------
 * Copyright (C) 1998-2009 PacketVideo
 *
 * 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.
 * -------------------------------------------------------------------
 */
/*
------------------------------------------------------------------------------

   PacketVideo Corp.
   MP3 Decoder Library

   Filename: pvmp3_equalizer.cpp


     Date: 09/21/2007

------------------------------------------------------------------------------
 REVISION HISTORY


 Description:

------------------------------------------------------------------------------
 INPUT AND OUTPUT DEFINITIONS

  Input
    int32          *inData,           pointer to the spectrum frequency-line
    e_equalization equalizerType,     equalization mode
    int32          *pt_work_buff

  Output
    int32          *pt_work_buff      pointer to the equalized frequency-line

------------------------------------------------------------------------------
 FUNCTION DESCRIPTION

    Equalizer
    Each subband sample is scaled according to a spectrum shape setting
    defined by "equalizerType"

------------------------------------------------------------------------------
 REQUIREMENTS


------------------------------------------------------------------------------
 REFERENCES

------------------------------------------------------------------------------
 PSEUDO-CODE

------------------------------------------------------------------------------
*/


/*----------------------------------------------------------------------------
; INCLUDES
----------------------------------------------------------------------------*/

#include "pvmp3_equalizer.h"
#include "pv_mp3dec_fxd_op.h"
#include "pvmp3_dec_defs.h"

/*----------------------------------------------------------------------------
; MACROS
; Define module specific macros here
----------------------------------------------------------------------------*/


/*----------------------------------------------------------------------------
; DEFINES
; Include all pre-processor statements here. Include conditional
; compile variables also.
----------------------------------------------------------------------------*/
#define LEVEL__0__dB  0.999999970f
#define LEVEL__1_5dB  0.841395142f
#define LEVEL__3__dB  0.707106781f
#define LEVEL__4_5dB  0.595662143f
#define LEVEL__6__dB  0.500000000f
#define LEVEL__7_5dB  0.421696503f
#define LEVEL__9__dB  0.353553393f
#define LEVEL_12__dB  0.250000000f
#define LEVEL_15__dB  0.176776695f
#define LEVEL_18__dB  0.125000000f
#define LEVEL_21__dB  0.088388347f
#define LEVEL_30__dB  0.031250000f
#define LEVEL_45__dB  0.005524271f
#define LEVEL_60__dB  0.000976562f

#define Qmf31( x)    (int32)((x)*(float)0x7FFFFFFF)


/*----------------------------------------------------------------------------
; LOCAL FUNCTION DEFINITIONS
; Function Prototype declaration
----------------------------------------------------------------------------*/

/*----------------------------------------------------------------------------
; LOCAL STORE/BUFFER/POINTER DEFINITIONS
; Variable declaration - defined here and used outside this module
----------------------------------------------------------------------------*/

const int32 equalizerTbl[8][SUBBANDS_NUMBER] =
{
    /*  FLAT */
    {
        Qmf31(LEVEL__0__dB),

        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),

        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),

        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),

        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB)
    },
    /*  BASS BOOST */
    {
        Qmf31(LEVEL__0__dB),

        Qmf31(LEVEL__1_5dB), Qmf31(LEVEL__3__dB),

        Qmf31(LEVEL__4_5dB), Qmf31(LEVEL__6__dB),
        Qmf31(LEVEL__6__dB), Qmf31(LEVEL__6__dB),

        Qmf31(LEVEL__6__dB), Qmf31(LEVEL__6__dB),
        Qmf31(LEVEL__6__dB), Qmf31(LEVEL__6__dB),
        Qmf31(LEVEL__6__dB), Qmf31(LEVEL__6__dB),
        Qmf31(LEVEL__6__dB), Qmf31(LEVEL__6__dB),

        Qmf31(LEVEL__6__dB), Qmf31(LEVEL__6__dB),
        Qmf31(LEVEL__6__dB), Qmf31(LEVEL__6__dB),
        Qmf31(LEVEL__6__dB), Qmf31(LEVEL__6__dB),
        Qmf31(LEVEL__6__dB), Qmf31(LEVEL__6__dB),
        Qmf31(LEVEL__6__dB), Qmf31(LEVEL__6__dB),
        Qmf31(LEVEL__6__dB), Qmf31(LEVEL__6__dB),
        Qmf31(LEVEL__6__dB), Qmf31(LEVEL__6__dB),
        Qmf31(LEVEL__6__dB), Qmf31(LEVEL__6__dB),
        Qmf31(LEVEL__6__dB)
    },
    /*  ROCK */
    {
        Qmf31(LEVEL__0__dB),

        Qmf31(LEVEL__1_5dB), Qmf31(LEVEL__3__dB),

        Qmf31(LEVEL__4_5dB), Qmf31(LEVEL__6__dB),
        Qmf31(LEVEL__6__dB), Qmf31(LEVEL__6__dB),

        Qmf31(LEVEL__3__dB), Qmf31(LEVEL__3__dB),
        Qmf31(LEVEL__3__dB), Qmf31(LEVEL__3__dB),
        Qmf31(LEVEL__3__dB), Qmf31(LEVEL__3__dB),
        Qmf31(LEVEL__3__dB), Qmf31(LEVEL__1_5dB),

        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB)
    },
    /*  POP */
    {
        Qmf31(LEVEL__6__dB),

        Qmf31(LEVEL__3__dB), Qmf31(LEVEL__3__dB),

        Qmf31(LEVEL__1_5dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),

        Qmf31(LEVEL__3__dB), Qmf31(LEVEL__3__dB),
        Qmf31(LEVEL__3__dB), Qmf31(LEVEL__3__dB),
        Qmf31(LEVEL__3__dB), Qmf31(LEVEL__3__dB),
        Qmf31(LEVEL__3__dB), Qmf31(LEVEL__3__dB),

        Qmf31(LEVEL__9__dB), Qmf31(LEVEL__9__dB),
        Qmf31(LEVEL__9__dB), Qmf31(LEVEL__9__dB),
        Qmf31(LEVEL__9__dB), Qmf31(LEVEL__9__dB),
        Qmf31(LEVEL__9__dB), Qmf31(LEVEL__9__dB),
        Qmf31(LEVEL__9__dB), Qmf31(LEVEL__9__dB),
        Qmf31(LEVEL__9__dB), Qmf31(LEVEL__9__dB),
        Qmf31(LEVEL__9__dB), Qmf31(LEVEL__9__dB),
        Qmf31(LEVEL__9__dB), Qmf31(LEVEL__9__dB),
        Qmf31(LEVEL__9__dB)
    },
    /*  JAZZ */
    {
        Qmf31(LEVEL__0__dB),

        Qmf31(LEVEL__6__dB), Qmf31(LEVEL__6__dB),

        Qmf31(LEVEL__9__dB), Qmf31(LEVEL__9__dB),
        Qmf31(LEVEL__9__dB), Qmf31(LEVEL__9__dB),

        Qmf31(LEVEL__3__dB), Qmf31(LEVEL__3__dB),
        Qmf31(LEVEL__3__dB), Qmf31(LEVEL__3__dB),
        Qmf31(LEVEL__3__dB), Qmf31(LEVEL__3__dB),
        Qmf31(LEVEL__3__dB), Qmf31(LEVEL__1_5dB),

        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB)
    },
    /*  CLASSICAL */
    {
        Qmf31(LEVEL__0__dB),

        Qmf31(LEVEL__9__dB), Qmf31(LEVEL__9__dB),

        Qmf31(LEVEL__9__dB), Qmf31(LEVEL__9__dB),
        Qmf31(LEVEL__9__dB), Qmf31(LEVEL__9__dB),

        Qmf31(LEVEL__3__dB), Qmf31(LEVEL__3__dB),
        Qmf31(LEVEL__3__dB), Qmf31(LEVEL__3__dB),
        Qmf31(LEVEL__3__dB), Qmf31(LEVEL__3__dB),
        Qmf31(LEVEL__3__dB), Qmf31(LEVEL__1_5dB),

        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB)
    },
    /*  TALK */
    {
        Qmf31(LEVEL__9__dB),

        Qmf31(LEVEL__6__dB), Qmf31(LEVEL__6__dB),

        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),

        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__1_5dB),

        Qmf31(LEVEL__3__dB), Qmf31(LEVEL__3__dB),
        Qmf31(LEVEL__3__dB), Qmf31(LEVEL__3__dB),
        Qmf31(LEVEL__3__dB), Qmf31(LEVEL__3__dB),
        Qmf31(LEVEL__3__dB), Qmf31(LEVEL__3__dB),
        Qmf31(LEVEL__3__dB), Qmf31(LEVEL__3__dB),
        Qmf31(LEVEL__3__dB), Qmf31(LEVEL__3__dB),
        Qmf31(LEVEL__3__dB), Qmf31(LEVEL__3__dB),
        Qmf31(LEVEL__3__dB), Qmf31(LEVEL__3__dB),
        Qmf31(LEVEL__3__dB)
    },
    /*  FLAT */
    {
        Qmf31(LEVEL__0__dB),

        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),

        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),

        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),

        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB), Qmf31(LEVEL__0__dB),
        Qmf31(LEVEL__0__dB)
    }
};

/*----------------------------------------------------------------------------
; EXTERNAL FUNCTION REFERENCES
; Declare functions defined elsewhere and referenced in this module
----------------------------------------------------------------------------*/

/*----------------------------------------------------------------------------
; EXTERNAL GLOBAL STORE/BUFFER/POINTER REFERENCES
; Declare variables used in this module but defined elsewhere
----------------------------------------------------------------------------*/


/*----------------------------------------------------------------------------
; FUNCTION CODE
----------------------------------------------------------------------------*/

void pvmp3_equalizer(int32 *circ_buffer,
                     e_equalization equalizerType,
                     int32 *work_buff)
{

    if (equalizerType == flat)
    {
        for (int32 band = 0; band < FILTERBANK_BANDS; band += 2)
        {

            int32 *pt_work_buff = &work_buff[band];
            int32 *inData = &circ_buffer[544 - (band<<5)];

            int32 i;
            for (i = 0; i < SUBBANDS_NUMBER*FILTERBANK_BANDS; i += FILTERBANK_BANDS << 2)
            {
                int32 temp1 = (pt_work_buff[ i ]);
                int32 temp2 = (pt_work_buff[ i +   FILTERBANK_BANDS ]);
                int32 temp3 = (pt_work_buff[ i + 2*FILTERBANK_BANDS ]);
                int32 temp4 = (pt_work_buff[ i + 3*FILTERBANK_BANDS ]);
                *(inData++) = temp1;
                *(inData++) = temp2;
                *(inData++) = temp3;
                *(inData++) = temp4;
            }

            inData -= SUBBANDS_NUMBER << 1;
            pt_work_buff++;

            for (i = 0; i < SUBBANDS_NUMBER*FILTERBANK_BANDS; i += FILTERBANK_BANDS << 2)
            {
                int32 temp1 = (pt_work_buff[ i ]);
                int32 temp2 = (pt_work_buff[ i +   FILTERBANK_BANDS ]);
                int32 temp3 = (pt_work_buff[ i + 2*FILTERBANK_BANDS ]);
                int32 temp4 = (pt_work_buff[ i + 3*FILTERBANK_BANDS ]);
                *(inData++) = temp1;
                *(inData++) = temp2;
                *(inData++) = temp3;
                *(inData++) = temp4;
            }
        }
    }
    else
    {
        const int32 *pt_equalizer = equalizerTbl[equalizerType&7];


        for (int32 band = 0; band < FILTERBANK_BANDS; band += 3)
        {
            int32 *inData = &circ_buffer[544 - (band<<5)];

            int32 *pt_work_buff = &work_buff[band];
            int32 i;

            for (i = 0; i < SUBBANDS_NUMBER*FILTERBANK_BANDS; i += FILTERBANK_BANDS << 2)
            {
                int32 temp1 = (pt_work_buff[ i ]);
                int32 temp2 = (pt_work_buff[ i +   FILTERBANK_BANDS ]);
                int32 temp3 = (pt_work_buff[ i + 2*FILTERBANK_BANDS ]);
                int32 temp4 = (pt_work_buff[ i + 3*FILTERBANK_BANDS ]);
                *(inData++) = fxp_mul32_Q32(temp1 << 1, *(pt_equalizer++));
                *(inData++) = fxp_mul32_Q32(temp2 << 1, *(pt_equalizer++));
                *(inData++) = fxp_mul32_Q32(temp3 << 1, *(pt_equalizer++));
                *(inData++) = fxp_mul32_Q32(temp4 << 1, *(pt_equalizer++));
            }

            pt_equalizer -= SUBBANDS_NUMBER;

            inData -= SUBBANDS_NUMBER << 1;
            pt_work_buff++;

            for (i = 0; i < SUBBANDS_NUMBER*FILTERBANK_BANDS; i += FILTERBANK_BANDS << 2)
            {
                int32 temp1 = (pt_work_buff[ i ]);
                int32 temp2 = (pt_work_buff[ i +   FILTERBANK_BANDS ]);
                int32 temp3 = (pt_work_buff[ i + 2*FILTERBANK_BANDS ]);
                int32 temp4 = (pt_work_buff[ i + 3*FILTERBANK_BANDS ]);
                *(inData++) = fxp_mul32_Q32(temp1 << 1, *(pt_equalizer++));
                *(inData++) = fxp_mul32_Q32(temp2 << 1, *(pt_equalizer++));
                *(inData++) = fxp_mul32_Q32(temp3 << 1, *(pt_equalizer++));
                *(inData++) = fxp_mul32_Q32(temp4 << 1, *(pt_equalizer++));
            }
            pt_equalizer -= SUBBANDS_NUMBER;

        }
    }
}