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
LVM_GetOmega(LVM_UINT32 Fc,LVM_Fs_en 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
LVM_GetOmega(LVM_UINT16 Fc,LVM_Fs_en Fs)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