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 "LVM_Macros.h"
20 #include "ScalarArithmetic.h"
21 #include "BIQUAD.h"
22 #include "Filter.h"
23
24
25 /*-------------------------------------------------------------------------*/
26 /* FUNCTION: */
27 /* void LVM_FO_LPF( LVM_INT32 w , */
28 /* FO_C32_Coefs_t *pCoeffs); */
29 /* */
30 /* */
31 /* DESCRIPTION: */
32 /* This function calculates the coefficient of first order low pass */
33 /* filter. It uses the equations: */
34 /* */
35 /* B1 = (tan(w/2) - 1 ) / (tan(w/2) + 1 ) */
36 /* A0 = (1 - B1) / 2 */
37 /* A1 = A0 */
38 /* */
39 /* The value of B1 is then calculated directly from the value w by a */
40 /* polynomial expansion using a 9th order polynomial. It uses the */
41 /* following table of 32-bit integer polynomial coefficients: */
42 /* */
43 /* Coefficient Value */
44 /* A0 -8388571 */
45 /* A1 33547744 */
46 /* A2 -66816791 */
47 /* A3 173375308 */
48 /* A4 -388437573 */
49 /* A5 752975383 */
50 /* A6 -1103016663 */
51 /* A7 1121848567 */
52 /* A8 -688078159 */
53 /* A9 194669577 */
54 /* A10 8 */
55 /* */
56 /* Y = (A0 + A1*X + A2*X2 + A3*X3 + �.. + AN*xN) << AN+1 */
57 /* */
58 /* */
59 /* PARAMETERS: */
60 /* */
61 /* w Sample rate in radians, where: */
62 /* w = 2 * Pi * Fc / Fs */
63 /* Fc is the corner frequency in Hz */
64 /* Fs is the sample rate in Hz */
65 /* w is in Q2.29 format and data range is [0 Pi] */
66 /* pCoeffs Points to the filter coefficients calculated here */
67 /* in Q1.30 format */
68 /* RETURNS: */
69 /* */
70 /*-------------------------------------------------------------------------*/
71 #ifdef BUILD_FLOAT
LVM_FO_HPF(LVM_FLOAT w,FO_FLOAT_Coefs_t * pCoeffs)72 LVM_FLOAT LVM_FO_HPF( LVM_FLOAT w,
73 FO_FLOAT_Coefs_t *pCoeffs)
74 {
75 LVM_FLOAT Y,Coefficients[13] = {-0.999996f,
76 0.999801f,
77 -0.497824f,
78 0.322937f,
79 -0.180880f,
80 0.087658f,
81 -0.032102f,
82 0.008163f,
83 -0.001252f,
84 0.000089f,
85 0,
86 0,
87 0};
88 Y=LVM_Polynomial((LVM_UINT16)9, Coefficients, w);
89
90 pCoeffs->B1 = -Y; /* Store -B1 in filter structure instead of B1!*/
91 /* A0=(1-B1)/2= B1/2 - 0.5*/
92 Y = Y / 2.0f; /* A0=Y=B1/2*/
93 Y = Y - 0.5f; /* A0=Y=(B1/2 - 0.5)*/
94
95 pCoeffs->A0 = Y * FILTER_LOSS_FLOAT; /* Apply loss to avoid overflow*/
96 pCoeffs->A1 = -pCoeffs->A0; /* Store A1=-A0*/
97
98 return 1;
99 }
100 #else
LVM_FO_HPF(LVM_INT32 w,FO_C32_Coefs_t * pCoeffs)101 LVM_INT32 LVM_FO_HPF( LVM_INT32 w,
102 FO_C32_Coefs_t *pCoeffs)
103 {
104 LVM_INT32 Y,Coefficients[13]={ -8388571,
105 33547744,
106 -66816791,
107 173375308,
108 -388437573,
109 752975383,
110 -1103016663,
111 1121848567,
112 -688078159,
113 194669577,
114 8,
115 0,
116 0};
117 Y=LVM_Polynomial( (LVM_UINT16)9,
118 Coefficients,
119 w);
120 pCoeffs->B1=-Y; /* Store -B1 in filter structure instead of B1!*/
121 /* A0=(1-B1)/2= B1/2 - 0.5*/
122 Y=Y>>1; /* A0=Y=B1/2*/
123 Y=Y-0x40000000; /* A0=Y=(B1/2 - 0.5)*/
124 MUL32x16INTO32(Y, FILTER_LOSS ,pCoeffs->A0 ,15) /* Apply loss to avoid overflow*/
125 pCoeffs->A1=-pCoeffs->A0; /* Store A1=-A0*/
126
127 return 1;
128 }
129 #endif
130