1 /* 2 * Copyright (C) 2004-2010 NXP Software 3 * Copyright (C) 2010 The Android Open Source Project 4 * 5 * Licensed under the Apache License, Version 2.0 (the "License"); 6 * you may not use this file except in compliance with the License. 7 * You may obtain a copy of the License at 8 * 9 * http://www.apache.org/licenses/LICENSE-2.0 10 * 11 * Unless required by applicable law or agreed to in writing, software 12 * distributed under the License is distributed on an "AS IS" BASIS, 13 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 14 * See the License for the specific language governing permissions and 15 * limitations under the License. 16 */ 17 18 #include "LVM_Types.h" 19 #include "Filter.h" 20 #include "LVM_Macros.h" 21 22 /************************************************************************************/ 23 /* */ 24 /* Defines and Tables for 2*Pi/Fs */ 25 /* */ 26 /************************************************************************************/ 27 28 #define LVVDL_2PiBy_8000 1727108826 /* In Q41 format */ 29 #define LVVDL_2PiBy_11025 1253230894 /* In Q41 format */ 30 #define LVVDL_2PiBy_12000 1151405884 /* In Q41 format */ 31 32 #define LVVDL_2PiByFs_SHIFT1 12 /* Qformat shift for 8kHz, 11.025kHz and 12kHz i.e. 12=41-29 */ 33 #define LVVDL_2PiByFs_SHIFT2 13 /* Qformat shift for 16kHz, 22.050kHz and 24kHz i.e. 13=42-29 */ 34 #define LVVDL_2PiByFs_SHIFT3 14 /* Qformat shift for 32kHz, 44.1kHz and 48kHz i.e. 14=43-29 */ 35 #ifndef BUILD_FLOAT 36 const LVM_INT32 LVVDL_2PiOnFsTable[] = {LVVDL_2PiBy_8000 , /* 8kHz in Q41, 16kHz in Q42, 32kHz in Q43 */ 37 LVVDL_2PiBy_11025, /* 11025 Hz in Q41, 22050Hz in Q42, 44100 Hz in Q43*/ 38 LVVDL_2PiBy_12000}; /* 12kHz in Q41, 24kHz in Q42, 48kHz in Q43 */ 39 #endif 40 41 const LVM_INT32 LVVDL_2PiOnFsShiftTable[]={LVVDL_2PiByFs_SHIFT1 , /* 8kHz, 11025Hz, 12kHz */ 42 LVVDL_2PiByFs_SHIFT2, /* 16kHz, 22050Hz, 24kHz*/ 43 LVVDL_2PiByFs_SHIFT3}; /* 32kHz, 44100Hz, 48kHz */ 44 #ifdef BUILD_FLOAT 45 #define LVVDL_2PiBy_8000_f 0.000785398f 46 #define LVVDL_2PiBy_11025_f 0.000569903f 47 #define LVVDL_2PiBy_12000_f 0.000523599f 48 #define LVVDL_2PiBy_16000_f 0.000392700f 49 #define LVVDL_2PiBy_22050_f 0.000284952f 50 #define LVVDL_2PiBy_24000_f 0.000261800f 51 #define LVVDL_2PiBy_32000_f 0.000196350f 52 #define LVVDL_2PiBy_44100_f 0.000142476f 53 #define LVVDL_2PiBy_48000_f 0.000130900f 54 55 #ifdef HIGHER_FS 56 #define LVVDL_2PiBy_88200_f 0.000071238f 57 #define LVVDL_2PiBy_96000_f 0.000065450f 58 #define LVVDL_2PiBy_176400_f 0.000035619f 59 #define LVVDL_2PiBy_192000_f 0.000032725f 60 #endif 61 const LVM_FLOAT LVVDL_2PiOnFsTable[] = {LVVDL_2PiBy_8000_f, 62 LVVDL_2PiBy_11025_f, 63 LVVDL_2PiBy_12000_f, 64 LVVDL_2PiBy_16000_f, 65 LVVDL_2PiBy_22050_f, 66 LVVDL_2PiBy_24000_f, 67 LVVDL_2PiBy_32000_f, 68 LVVDL_2PiBy_44100_f, 69 LVVDL_2PiBy_48000_f 70 #ifdef HIGHER_FS 71 ,LVVDL_2PiBy_88200_f 72 ,LVVDL_2PiBy_96000_f 73 ,LVVDL_2PiBy_176400_f 74 ,LVVDL_2PiBy_192000_f 75 #endif 76 }; 77 #endif 78 /*-------------------------------------------------------------------------*/ 79 /* FUNCTION: */ 80 /* LVM_GetOmega */ 81 /* */ 82 /* LVM_INT32 LVM_GetOmega(LVM_UINT16 Fc, */ 83 /* LVM_Fs_en Fs) */ 84 /* */ 85 /* DESCRIPTION: */ 86 /* This function calculates the value of w using Fc and Fs */ 87 /* */ 88 /* PARAMETERS: */ 89 /* */ 90 /* LVM_UINT16 Fc The corner frequency in Hz Q16.0 format */ 91 /* LVM_Fs_en Fs The SampleRate */ 92 /* RETURNS: */ 93 /* w=2*pi*Fc/Fs in Q2.29 format */ 94 /*-------------------------------------------------------------------------*/ 95 #ifdef BUILD_FLOAT 96 #ifdef HIGHER_FS 97 LVM_FLOAT LVM_GetOmega(LVM_UINT32 Fc, 98 LVM_Fs_en Fs) 99 #else 100 LVM_FLOAT LVM_GetOmega(LVM_UINT16 Fc, 101 LVM_Fs_en Fs) 102 #endif 103 { 104 LVM_FLOAT w; 105 w = (LVM_FLOAT)Fc * LVVDL_2PiOnFsTable[Fs]; 106 return w; 107 } 108 #else 109 LVM_INT32 LVM_GetOmega(LVM_UINT16 Fc, 110 LVM_Fs_en Fs) 111 { 112 LVM_INT32 w; 113 MUL32x32INTO32((LVM_INT32)Fc,LVVDL_2PiOnFsTable[Fs%3],w,LVVDL_2PiOnFsShiftTable[Fs/3]) 114 return w; 115 } 116 #endif 117