| /* ------------------------------------------------------------------ |
| * 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; |
| |
| } |
| } |
| } |
| |
| |
| |
| |
