| /* |
| * 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. |
| */ |
| |
| #include "LVM_Types.h" |
| #include "Filter.h" |
| #include "LVM_Macros.h" |
| |
| /************************************************************************************/ |
| /* */ |
| /* Defines and Tables for 2*Pi/Fs */ |
| /* */ |
| /************************************************************************************/ |
| |
| #define LVVDL_2PiBy_8000 1727108826 /* In Q41 format */ |
| #define LVVDL_2PiBy_11025 1253230894 /* In Q41 format */ |
| #define LVVDL_2PiBy_12000 1151405884 /* In Q41 format */ |
| |
| #define LVVDL_2PiByFs_SHIFT1 12 /* Qformat shift for 8kHz, 11.025kHz and 12kHz i.e. 12=41-29 */ |
| #define LVVDL_2PiByFs_SHIFT2 13 /* Qformat shift for 16kHz, 22.050kHz and 24kHz i.e. 13=42-29 */ |
| #define LVVDL_2PiByFs_SHIFT3 14 /* Qformat shift for 32kHz, 44.1kHz and 48kHz i.e. 14=43-29 */ |
| #ifndef BUILD_FLOAT |
| const LVM_INT32 LVVDL_2PiOnFsTable[] = {LVVDL_2PiBy_8000 , /* 8kHz in Q41, 16kHz in Q42, 32kHz in Q43 */ |
| LVVDL_2PiBy_11025, /* 11025 Hz in Q41, 22050Hz in Q42, 44100 Hz in Q43*/ |
| LVVDL_2PiBy_12000}; /* 12kHz in Q41, 24kHz in Q42, 48kHz in Q43 */ |
| #endif |
| |
| const LVM_INT32 LVVDL_2PiOnFsShiftTable[]={LVVDL_2PiByFs_SHIFT1 , /* 8kHz, 11025Hz, 12kHz */ |
| LVVDL_2PiByFs_SHIFT2, /* 16kHz, 22050Hz, 24kHz*/ |
| LVVDL_2PiByFs_SHIFT3}; /* 32kHz, 44100Hz, 48kHz */ |
| #ifdef BUILD_FLOAT |
| #define LVVDL_2PiBy_8000_f 0.000785398f |
| #define LVVDL_2PiBy_11025_f 0.000569903f |
| #define LVVDL_2PiBy_12000_f 0.000523599f |
| #define LVVDL_2PiBy_16000_f 0.000392700f |
| #define LVVDL_2PiBy_22050_f 0.000284952f |
| #define LVVDL_2PiBy_24000_f 0.000261800f |
| #define LVVDL_2PiBy_32000_f 0.000196350f |
| #define LVVDL_2PiBy_44100_f 0.000142476f |
| #define LVVDL_2PiBy_48000_f 0.000130900f |
| |
| #ifdef HIGHER_FS |
| #define LVVDL_2PiBy_96000_f 0.000065450f |
| #define LVVDL_2PiBy_192000_f 0.000032725f |
| #endif |
| const LVM_FLOAT LVVDL_2PiOnFsTable[] = {LVVDL_2PiBy_8000_f, |
| LVVDL_2PiBy_11025_f, |
| LVVDL_2PiBy_12000_f, |
| LVVDL_2PiBy_16000_f, |
| LVVDL_2PiBy_22050_f, |
| LVVDL_2PiBy_24000_f, |
| LVVDL_2PiBy_32000_f, |
| LVVDL_2PiBy_44100_f, |
| LVVDL_2PiBy_48000_f |
| #ifdef HIGHER_FS |
| ,LVVDL_2PiBy_96000_f |
| ,LVVDL_2PiBy_192000_f |
| #endif |
| }; |
| #endif |
| /*-------------------------------------------------------------------------*/ |
| /* FUNCTION: */ |
| /* LVM_GetOmega */ |
| /* */ |
| /* LVM_INT32 LVM_GetOmega(LVM_UINT16 Fc, */ |
| /* LVM_Fs_en Fs) */ |
| /* */ |
| /* DESCRIPTION: */ |
| /* This function calculates the value of w using Fc and Fs */ |
| /* */ |
| /* PARAMETERS: */ |
| /* */ |
| /* LVM_UINT16 Fc The corner frequency in Hz Q16.0 format */ |
| /* LVM_Fs_en Fs The SampleRate */ |
| /* RETURNS: */ |
| /* w=2*pi*Fc/Fs in Q2.29 format */ |
| /*-------------------------------------------------------------------------*/ |
| #ifdef BUILD_FLOAT |
| #ifdef HIGHER_FS |
| LVM_FLOAT LVM_GetOmega(LVM_UINT32 Fc, |
| LVM_Fs_en Fs) |
| #else |
| LVM_FLOAT LVM_GetOmega(LVM_UINT16 Fc, |
| LVM_Fs_en Fs) |
| #endif |
| { |
| LVM_FLOAT w; |
| w = (LVM_FLOAT)Fc * LVVDL_2PiOnFsTable[Fs]; |
| return w; |
| } |
| #else |
| LVM_INT32 LVM_GetOmega(LVM_UINT16 Fc, |
| LVM_Fs_en Fs) |
| { |
| LVM_INT32 w; |
| MUL32x32INTO32((LVM_INT32)Fc,LVVDL_2PiOnFsTable[Fs%3],w,LVVDL_2PiOnFsShiftTable[Fs/3]) |
| return w; |
| } |
| #endif |