| /* |
| * 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 "LVCS_Private.h" |
| #include "Filters.h" /* Filter definitions */ |
| #include "BIQUAD.h" /* Biquad definitions */ |
| #include "LVCS_Headphone_Coeffs.h" /* Headphone coefficients */ |
| |
| |
| /************************************************************************************/ |
| /* */ |
| /* Stereo Enhancer coefficient constant tables */ |
| /* */ |
| /************************************************************************************/ |
| |
| /* Coefficient table for the middle filter */ |
| const BiquadA01B1CoefsSP_t LVCS_SEMidCoefTable[] = { |
| {CS_MIDDLE_8000_A0, /* 8kS/s coefficients */ |
| CS_MIDDLE_8000_A1, |
| CS_MIDDLE_8000_B1, |
| (LVM_UINT16 )CS_MIDDLE_8000_SCALE}, |
| {CS_MIDDLE_11025_A0, /* 11kS/s coefficients */ |
| CS_MIDDLE_11025_A1, |
| CS_MIDDLE_11025_B1, |
| (LVM_UINT16 )CS_MIDDLE_11025_SCALE}, |
| {CS_MIDDLE_12000_A0, /* 12kS/s coefficients */ |
| CS_MIDDLE_12000_A1, |
| CS_MIDDLE_12000_B1, |
| (LVM_UINT16 )CS_MIDDLE_12000_SCALE}, |
| {CS_MIDDLE_16000_A0, /* 16kS/s coefficients */ |
| CS_MIDDLE_16000_A1, |
| CS_MIDDLE_16000_B1, |
| (LVM_UINT16 )CS_MIDDLE_16000_SCALE}, |
| {CS_MIDDLE_22050_A0, /* 22kS/s coefficients */ |
| CS_MIDDLE_22050_A1, |
| CS_MIDDLE_22050_B1, |
| (LVM_UINT16 )CS_MIDDLE_22050_SCALE}, |
| {CS_MIDDLE_24000_A0, /* 24kS/s coefficients */ |
| CS_MIDDLE_24000_A1, |
| CS_MIDDLE_24000_B1, |
| (LVM_UINT16 )CS_MIDDLE_24000_SCALE}, |
| {CS_MIDDLE_32000_A0, /* 32kS/s coefficients */ |
| CS_MIDDLE_32000_A1, |
| CS_MIDDLE_32000_B1, |
| (LVM_UINT16 )CS_MIDDLE_32000_SCALE}, |
| {CS_MIDDLE_44100_A0, /* 44kS/s coefficients */ |
| CS_MIDDLE_44100_A1, |
| CS_MIDDLE_44100_B1, |
| (LVM_UINT16 )CS_MIDDLE_44100_SCALE}, |
| {CS_MIDDLE_48000_A0, /* 48kS/s coefficients */ |
| CS_MIDDLE_48000_A1, |
| CS_MIDDLE_48000_B1, |
| (LVM_UINT16 )CS_MIDDLE_48000_SCALE}}; |
| |
| /* Coefficient table for the side filter */ |
| const BiquadA012B12CoefsSP_t LVCS_SESideCoefTable[] = { |
| /* Headphone Side coefficients */ |
| {CS_SIDE_8000_A0, /* 8kS/s coefficients */ |
| CS_SIDE_8000_A1, |
| CS_SIDE_8000_A2, |
| CS_SIDE_8000_B1, |
| CS_SIDE_8000_B2, |
| (LVM_UINT16 )CS_SIDE_8000_SCALE}, |
| {CS_SIDE_11025_A0, /* 11kS/s coefficients */ |
| CS_SIDE_11025_A1, |
| CS_SIDE_11025_A2, |
| CS_SIDE_11025_B1, |
| CS_SIDE_11025_B2, |
| (LVM_UINT16 )CS_SIDE_11025_SCALE}, |
| {CS_SIDE_12000_A0, /* 12kS/s coefficients */ |
| CS_SIDE_12000_A1, |
| CS_SIDE_12000_A2, |
| CS_SIDE_12000_B1, |
| CS_SIDE_12000_B2, |
| (LVM_UINT16 )CS_SIDE_12000_SCALE}, |
| {CS_SIDE_16000_A0, /* 16kS/s coefficients */ |
| CS_SIDE_16000_A1, |
| CS_SIDE_16000_A2, |
| CS_SIDE_16000_B1, |
| CS_SIDE_16000_B2, |
| (LVM_UINT16 )CS_SIDE_16000_SCALE}, |
| {CS_SIDE_22050_A0, /* 22kS/s coefficients */ |
| CS_SIDE_22050_A1, |
| CS_SIDE_22050_A2, |
| CS_SIDE_22050_B1, |
| CS_SIDE_22050_B2, |
| (LVM_UINT16 )CS_SIDE_22050_SCALE}, |
| {CS_SIDE_24000_A0, /* 24kS/s coefficients */ |
| CS_SIDE_24000_A1, |
| CS_SIDE_24000_A2, |
| CS_SIDE_24000_B1, |
| CS_SIDE_24000_B2, |
| (LVM_UINT16 )CS_SIDE_24000_SCALE}, |
| {CS_SIDE_32000_A0, /* 32kS/s coefficients */ |
| CS_SIDE_32000_A1, |
| CS_SIDE_32000_A2, |
| CS_SIDE_32000_B1, |
| CS_SIDE_32000_B2, |
| (LVM_UINT16 )CS_SIDE_32000_SCALE}, |
| {CS_SIDE_44100_A0, /* 44kS/s coefficients */ |
| CS_SIDE_44100_A1, |
| CS_SIDE_44100_A2, |
| CS_SIDE_44100_B1, |
| CS_SIDE_44100_B2, |
| (LVM_UINT16 )CS_SIDE_44100_SCALE}, |
| {CS_SIDE_48000_A0, /* 48kS/s coefficients */ |
| CS_SIDE_48000_A1, |
| CS_SIDE_48000_A2, |
| CS_SIDE_48000_B1, |
| CS_SIDE_48000_B2, |
| (LVM_UINT16 )CS_SIDE_48000_SCALE} |
| }; |
| |
| |
| /************************************************************************************/ |
| /* */ |
| /* Equaliser coefficient constant tables */ |
| /* */ |
| /************************************************************************************/ |
| |
| const BiquadA012B12CoefsSP_t LVCS_EqualiserCoefTable[] = { |
| /* Headphone coefficients */ |
| {CS_EQUALISER_8000_A0, /* 8kS/s coefficients */ |
| CS_EQUALISER_8000_A1, |
| CS_EQUALISER_8000_A2, |
| CS_EQUALISER_8000_B1, |
| CS_EQUALISER_8000_B2, |
| (LVM_UINT16 )CS_EQUALISER_8000_SCALE}, |
| {CS_EQUALISER_11025_A0, /* 11kS/s coefficients */ |
| CS_EQUALISER_11025_A1, |
| CS_EQUALISER_11025_A2, |
| CS_EQUALISER_11025_B1, |
| CS_EQUALISER_11025_B2, |
| (LVM_UINT16 )CS_EQUALISER_11025_SCALE}, |
| {CS_EQUALISER_12000_A0, /* 12kS/s coefficients */ |
| CS_EQUALISER_12000_A1, |
| CS_EQUALISER_12000_A2, |
| CS_EQUALISER_12000_B1, |
| CS_EQUALISER_12000_B2, |
| (LVM_UINT16 )CS_EQUALISER_12000_SCALE}, |
| {CS_EQUALISER_16000_A0, /* 16kS/s coefficients */ |
| CS_EQUALISER_16000_A1, |
| CS_EQUALISER_16000_A2, |
| CS_EQUALISER_16000_B1, |
| CS_EQUALISER_16000_B2, |
| (LVM_UINT16 )CS_EQUALISER_16000_SCALE}, |
| {CS_EQUALISER_22050_A0, /* 22kS/s coefficients */ |
| CS_EQUALISER_22050_A1, |
| CS_EQUALISER_22050_A2, |
| CS_EQUALISER_22050_B1, |
| CS_EQUALISER_22050_B2, |
| (LVM_UINT16 )CS_EQUALISER_22050_SCALE}, |
| {CS_EQUALISER_24000_A0, /* 24kS/s coefficients */ |
| CS_EQUALISER_24000_A1, |
| CS_EQUALISER_24000_A2, |
| CS_EQUALISER_24000_B1, |
| CS_EQUALISER_24000_B2, |
| (LVM_UINT16 )CS_EQUALISER_24000_SCALE}, |
| {CS_EQUALISER_32000_A0, /* 32kS/s coefficients */ |
| CS_EQUALISER_32000_A1, |
| CS_EQUALISER_32000_A2, |
| CS_EQUALISER_32000_B1, |
| CS_EQUALISER_32000_B2, |
| (LVM_UINT16 )CS_EQUALISER_32000_SCALE}, |
| {CS_EQUALISER_44100_A0, /* 44kS/s coefficients */ |
| CS_EQUALISER_44100_A1, |
| CS_EQUALISER_44100_A2, |
| CS_EQUALISER_44100_B1, |
| CS_EQUALISER_44100_B2, |
| (LVM_UINT16 )CS_EQUALISER_44100_SCALE}, |
| {CS_EQUALISER_48000_A0, /* 48kS/s coefficients */ |
| CS_EQUALISER_48000_A1, |
| CS_EQUALISER_48000_A2, |
| CS_EQUALISER_48000_B1, |
| CS_EQUALISER_48000_B2, |
| (LVM_UINT16 )CS_EQUALISER_48000_SCALE}, |
| |
| /* Concert Sound EX Headphone coefficients */ |
| {CSEX_EQUALISER_8000_A0, /* 8kS/s coefficients */ |
| CSEX_EQUALISER_8000_A1, |
| CSEX_EQUALISER_8000_A2, |
| CSEX_EQUALISER_8000_B1, |
| CSEX_EQUALISER_8000_B2, |
| (LVM_UINT16 )CSEX_EQUALISER_8000_SCALE}, |
| {CSEX_EQUALISER_11025_A0, /* 11kS/s coefficients */ |
| CSEX_EQUALISER_11025_A1, |
| CSEX_EQUALISER_11025_A2, |
| CSEX_EQUALISER_11025_B1, |
| CSEX_EQUALISER_11025_B2, |
| (LVM_UINT16 )CSEX_EQUALISER_11025_SCALE}, |
| {CSEX_EQUALISER_12000_A0, /* 12kS/s coefficients */ |
| CSEX_EQUALISER_12000_A1, |
| CSEX_EQUALISER_12000_A2, |
| CSEX_EQUALISER_12000_B1, |
| CSEX_EQUALISER_12000_B2, |
| (LVM_UINT16 )CSEX_EQUALISER_12000_SCALE}, |
| {CSEX_EQUALISER_16000_A0, /* 16kS/s coefficients */ |
| CSEX_EQUALISER_16000_A1, |
| CSEX_EQUALISER_16000_A2, |
| CSEX_EQUALISER_16000_B1, |
| CSEX_EQUALISER_16000_B2, |
| (LVM_UINT16 )CSEX_EQUALISER_16000_SCALE}, |
| {CSEX_EQUALISER_22050_A0, /* 22kS/s coefficients */ |
| CSEX_EQUALISER_22050_A1, |
| CSEX_EQUALISER_22050_A2, |
| CSEX_EQUALISER_22050_B1, |
| CSEX_EQUALISER_22050_B2, |
| (LVM_UINT16 )CSEX_EQUALISER_22050_SCALE}, |
| {CSEX_EQUALISER_24000_A0, /* 24kS/s coefficients */ |
| CSEX_EQUALISER_24000_A1, |
| CSEX_EQUALISER_24000_A2, |
| CSEX_EQUALISER_24000_B1, |
| CSEX_EQUALISER_24000_B2, |
| (LVM_UINT16 )CSEX_EQUALISER_24000_SCALE}, |
| {CSEX_EQUALISER_32000_A0, /* 32kS/s coefficients */ |
| CSEX_EQUALISER_32000_A1, |
| CSEX_EQUALISER_32000_A2, |
| CSEX_EQUALISER_32000_B1, |
| CSEX_EQUALISER_32000_B2, |
| (LVM_UINT16 )CSEX_EQUALISER_32000_SCALE}, |
| {CSEX_EQUALISER_44100_A0, /* 44kS/s coefficients */ |
| CSEX_EQUALISER_44100_A1, |
| CSEX_EQUALISER_44100_A2, |
| CSEX_EQUALISER_44100_B1, |
| CSEX_EQUALISER_44100_B2, |
| (LVM_UINT16 )CSEX_EQUALISER_44100_SCALE}, |
| {CSEX_EQUALISER_48000_A0, /* 48kS/s coefficients */ |
| CSEX_EQUALISER_48000_A1, |
| CSEX_EQUALISER_48000_A2, |
| CSEX_EQUALISER_48000_B1, |
| CSEX_EQUALISER_48000_B2, |
| (LVM_UINT16 )CSEX_EQUALISER_48000_SCALE} |
| }; |
| |
| |
| /************************************************************************************/ |
| /* */ |
| /* Reverb delay constant tables */ |
| /* */ |
| /************************************************************************************/ |
| |
| /* Stereo delay table for Concert Sound */ |
| const LVM_UINT16 LVCS_StereoDelayCS[] = { |
| LVCS_STEREODELAY_CS_8KHZ, |
| LVCS_STEREODELAY_CS_11KHZ, |
| LVCS_STEREODELAY_CS_12KHZ, |
| LVCS_STEREODELAY_CS_16KHZ, |
| LVCS_STEREODELAY_CS_22KHZ, |
| LVCS_STEREODELAY_CS_24KHZ, |
| LVCS_STEREODELAY_CS_32KHZ, |
| LVCS_STEREODELAY_CS_44KHZ, |
| LVCS_STEREODELAY_CS_48KHZ}; |
| |
| /************************************************************************************/ |
| /* */ |
| /* Reverb coefficients constant table */ |
| /* */ |
| /************************************************************************************/ |
| |
| const BiquadA012B12CoefsSP_t LVCS_ReverbCoefTable[] = { |
| /* Headphone coefficients */ |
| {CS_REVERB_8000_A0, /* 8kS/s coefficients */ |
| CS_REVERB_8000_A1, |
| CS_REVERB_8000_A2, |
| CS_REVERB_8000_B1, |
| CS_REVERB_8000_B2, |
| (LVM_UINT16 )CS_REVERB_8000_SCALE}, |
| {CS_REVERB_11025_A0, /* 11kS/s coefficients */ |
| CS_REVERB_11025_A1, |
| CS_REVERB_11025_A2, |
| CS_REVERB_11025_B1, |
| CS_REVERB_11025_B2, |
| (LVM_UINT16 )CS_REVERB_11025_SCALE}, |
| {CS_REVERB_12000_A0, /* 12kS/s coefficients */ |
| CS_REVERB_12000_A1, |
| CS_REVERB_12000_A2, |
| CS_REVERB_12000_B1, |
| CS_REVERB_12000_B2, |
| (LVM_UINT16 )CS_REVERB_12000_SCALE}, |
| {CS_REVERB_16000_A0, /* 16kS/s coefficients */ |
| CS_REVERB_16000_A1, |
| CS_REVERB_16000_A2, |
| CS_REVERB_16000_B1, |
| CS_REVERB_16000_B2, |
| (LVM_UINT16 )CS_REVERB_16000_SCALE}, |
| {CS_REVERB_22050_A0, /* 22kS/s coefficients */ |
| CS_REVERB_22050_A1, |
| CS_REVERB_22050_A2, |
| CS_REVERB_22050_B1, |
| CS_REVERB_22050_B2, |
| (LVM_UINT16 )CS_REVERB_22050_SCALE}, |
| {CS_REVERB_24000_A0, /* 24kS/s coefficients */ |
| CS_REVERB_24000_A1, |
| CS_REVERB_24000_A2, |
| CS_REVERB_24000_B1, |
| CS_REVERB_24000_B2, |
| (LVM_UINT16 )CS_REVERB_24000_SCALE}, |
| {CS_REVERB_32000_A0, /* 32kS/s coefficients */ |
| CS_REVERB_32000_A1, |
| CS_REVERB_32000_A2, |
| CS_REVERB_32000_B1, |
| CS_REVERB_32000_B2, |
| (LVM_UINT16 )CS_REVERB_32000_SCALE}, |
| {CS_REVERB_44100_A0, /* 44kS/s coefficients */ |
| CS_REVERB_44100_A1, |
| CS_REVERB_44100_A2, |
| CS_REVERB_44100_B1, |
| CS_REVERB_44100_B2, |
| (LVM_UINT16 )CS_REVERB_44100_SCALE}, |
| {CS_REVERB_48000_A0, /* 48kS/s coefficients */ |
| CS_REVERB_48000_A1, |
| CS_REVERB_48000_A2, |
| CS_REVERB_48000_B1, |
| CS_REVERB_48000_B2, |
| (LVM_UINT16 )CS_REVERB_48000_SCALE} |
| }; |
| |
| |
| /************************************************************************************/ |
| /* */ |
| /* Bypass mixer constant tables */ |
| /* */ |
| /************************************************************************************/ |
| |
| const Gain_t LVCS_OutputGainTable[] = { |
| {LVCS_HEADPHONE_SHIFT, /* Headphone, stereo mode */ |
| LVCS_HEADPHONE_SHIFTLOSS, |
| LVCS_HEADPHONE_GAIN}, |
| {LVCS_EX_HEADPHONE_SHIFT, /* EX Headphone, stereo mode */ |
| LVCS_EX_HEADPHONE_SHIFTLOSS, |
| LVCS_EX_HEADPHONE_GAIN}, |
| {LVCS_HEADPHONE_SHIFT, /* Headphone, mono mode */ |
| LVCS_HEADPHONE_SHIFTLOSS, |
| LVCS_HEADPHONE_GAIN}, |
| {LVCS_EX_HEADPHONE_SHIFT, /* EX Headphone, mono mode */ |
| LVCS_EX_HEADPHONE_SHIFTLOSS, |
| LVCS_EX_HEADPHONE_GAIN} |
| }; |
| |
| |
| /************************************************************************************/ |
| /* */ |
| /* Volume correction table */ |
| /* */ |
| /* Coefficient order: */ |
| /* Compression 100% effect */ |
| /* Compression 0% effect */ |
| /* Gain 100% effect */ |
| /* Gain 0% effect */ |
| /* */ |
| /* The Compression gain is represented by a Q1.15 number to give a range of 0dB */ |
| /* to +6dB, E.g.: */ |
| /* 0 is 0dB compression (no effect) */ |
| /* 5461 is 1dB compression gain */ |
| /* 10923 is 2dB compression gain */ |
| /* 32767 is 6dB compression gain */ |
| /* */ |
| /* The Gain is represented as a Q3.13 number to give a range of +8 to -infinity */ |
| /* E.g.: */ |
| /* 0 is -infinity */ |
| /* 32767 is +18dB (x8) gain */ |
| /* 4096 is 0dB gain */ |
| /* 1024 is -12dB gain */ |
| /* */ |
| /************************************************************************************/ |
| const LVCS_VolCorrect_t LVCS_VolCorrectTable[] = { |
| {14200, /* Headphone, stereo mode */ |
| 0, |
| 4096, |
| 5786}, |
| {14200, /* EX Headphone, stereo mode */ |
| 0, |
| 4096, |
| 5786}, |
| {32767, /* Headphone, mono mode */ |
| 0, |
| 4096, |
| 5786}, |
| {32767, /* EX Headphone, mono mode */ |
| 0, |
| 4096, |
| 5786} |
| }; |
| |
| /************************************************************************************/ |
| /* */ |
| /* Mixer time constants, 100ms */ |
| /* */ |
| /************************************************************************************/ |
| |
| #define LVCS_VOL_TC_Fs8000 32580 /* Floating point value 0.994262695 */ |
| #define LVCS_VOL_TC_Fs11025 32632 /* Floating point value 0.995849609 */ |
| #define LVCS_VOL_TC_Fs12000 32643 /* Floating point value 0.996185303 */ |
| #define LVCS_VOL_TC_Fs16000 32674 /* Floating point value 0.997131348 */ |
| #define LVCS_VOL_TC_Fs22050 32700 /* Floating point value 0.997924805 */ |
| #define LVCS_VOL_TC_Fs24000 32705 /* Floating point value 0.998077393 */ |
| #define LVCS_VOL_TC_Fs32000 32721 /* Floating point value 0.998565674 */ |
| #define LVCS_VOL_TC_Fs44100 32734 /* Floating point value 0.998962402 */ |
| #define LVCS_VOL_TC_Fs48000 32737 /* Floating point value 0.999053955 */ |
| |
| |
| const LVM_INT16 LVCS_VolumeTCTable[9] = {LVCS_VOL_TC_Fs8000, |
| LVCS_VOL_TC_Fs11025, |
| LVCS_VOL_TC_Fs12000, |
| LVCS_VOL_TC_Fs16000, |
| LVCS_VOL_TC_Fs22050, |
| LVCS_VOL_TC_Fs24000, |
| LVCS_VOL_TC_Fs32000, |
| LVCS_VOL_TC_Fs44100, |
| LVCS_VOL_TC_Fs48000}; |
| |
| /************************************************************************************/ |
| /* */ |
| /* Sample rate table */ |
| /* */ |
| /************************************************************************************/ |
| |
| const LVM_INT32 LVCS_SampleRateTable[9] = {8000, |
| 11025, |
| 12000, |
| 16000, |
| 22050, |
| 24000, |
| 32000, |
| 44100, |
| 48000}; |
| |